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Methods  are  developed  for  predicting  vibration  response  characteristics 
of  systems  which  change  configuration  during  operation.  A  cartesian  robot, 
an  example  of  such  a  position-dependent  system,  served  as  a  tfcst  case  for 
these  methods  and  was  studied  in  detail. 

The  chosen  system  model  was  formulated  using  the  technique  of  Compo¬ 
nent  Mode  Synthesis  (CMS).  The  model  assumes  that  the  system  is  slowly 
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varying,  and  connects  the  carriages  to  each  other  and  to  the  robot  structure 
at  the  siowiy-varying  connection  points.  The  modal  data  required  for  each 
component  is  obtained  experimentally  in  order  to  get  a  realistic  model. 
The  analysis  results  in  prediction  of  vibrations  that  are  produced  by  the 
inertia  forces  as  well  as  gravity  and  friction  forces  which  arise  when  the 
robot  carriages  move  with  some  prescribed  motion. 

Computer  simulations  and  experimental  determinations  are  conducted 
in  order  to  calculate  the  vibrations  at  the  robot  end-effector.  Comparisons, 
are  shown  to  validate  the  model  in  two  ways:  for  fixed-configuration  the 
mode  shapes  and  natural  frequencies  are  examined,  and  then  for  changing 
configuration  the  residual  vibration  at  the  end  of  the  move  is  evaluated. 

A  preliminary  study  was  done  on  a  geometrically  nonlinear  system 
which  also  has  position-dependency.  The  system  consisted  of  a  flexible 
four-bar  linkage  with  elastic  input  and  output  shafts.  The  behavior  of  the 
rocker-beam  is  analyzed  for  different  boundary  conditions  to  show  how  some 
limiting  cases  are  obtained.  A  dimensional  analysis  leads  to  an  evaluation 
of  the  consequences  of  dynamic  similarity  on  the  resulting  vibration. 
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Abstract 

Methods  are  developed  for  predicting  vibration  response  characteristics 
of  systems  which  change  configuration  during  operation.  A  cartesian  robot, 
an  example  of  such  a  position-dependent  system,  served  as  a  test  case  for 
these  methods  and  was  studied  in  detail. 

The  chosen  system  mode!  was  formulated  using  the  technique  of  Compo¬ 
nent  Mode  Synthesis!  {CMS)  <\Thejmodel  assumes  that  the  system  is  slowly 
varying,  and  connects  the  carriages  to  each  other  and  to  the  robot  structure 
at  the  slowly-varying  connection  points.  The  modal  data  required  for  each 
component  is  obtained  experimentally  in  order  to  get  a  realistic  model. 
The  analysis  results  in  prediction  of  vibrations  that  are  produced  by  the 
inertia  forces  as  well  as  gravity  and  friction  forces  which  arise  when  the 
robot  carriages  move  with  some  prescribed  motion. 

Computer  simulations  and  experimental  determinations  are  conducted 
in  order  to  calculate  the  vibrations  at  the  robot  end-effector.  Comparisons 
are  shown  to  validate  the  model  in  two  ways:  for  fixed-configuration  the 
mode  shapes  and  natural  frequencies  are  examined,  and  then  for  changing 
configuration  the  residual  vibration  at  the  end  of  the  move  is  evaluated. 

A  preliminary  study  was  done  on  a  geometrically  nonlinear  system 
which  also  has  position-dependency.  \The  system  consisted  of  a  flexible 
four-bar  linkage  with  elastic  input  and  output  shafts.  The  behavior  of  the 
rocker-beam  is  analyzed  for  different  boundary  conditions  to  show  how  some 
limiting  cases  are  obtained.  A  dimensional  analysis  leads  to  an  evaluation 
of  the  consequences  of  dynamic  similarity  on  the  resulting  vibration. 
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Chapter  1 


INTRODUCTION 


1.1  Summary 

A  position-dependent  system  in  vibration  analysis  is  defined  as  a  system 
whose  vibration  characteristics  are  changing  as  its  components  change  their 
relative  positions.  Machines  and  structures  such  as  crimes  and  bridges  are 
examples  of  such  systems.  One  such  system  which  motivated  the  present 
analysis,  is  a  cartesian  robot  (seen  in  Figure  1.1)  as  a  structure  with  moving 
carriages)  whose  dynamic  performance  needs  to  be  predicted  accurately 
during  the  motion  of  the  carriages. 

The  importance  of  the  present  analysis  comes  from  the  fact  that  this  is  a 
precision  assembly  robot  and  any  residua]  vibration  at  the  end  of  the  move 
can  badly  affect  assembly  operations  with  small  tolerances.  So,  it  would  be 
desirable  to  have  a  good  mathematical  model  of  how  the  vibrations  evolve 
during  the  motion  so  that  these  vibrations  could  be  actively  controlled.  It 
could  also  be  used  as  a  design  model. 

The  mathematical  model  to  be  developed  should  be  accurate  and  fast 
to  execute  when  implemented  in  a  computer.  The  approach  followed  to 
develop  this  model  was  based  on  Component  Mode  Synthesis  which  is  a 
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method  to  connect  substructures  to  predict  the  dynamic  behavior  of  an 
assembly  based  on  the  dynamic  behavior  of  each  substructure.  This  method 
(CMS),  traditionally  applied  to  connect  parts  that  form  a  time- invariant 
system  can  be  extended  to  position-dependent  systems  under  the  following 
assumption:  that  the  system  is  of  slowly-varying  coefficients;  that  is,  that 
any  appreciable  change  in  the  system  coefficients  occurs  after  many  cycles 
of  vibration. 

Experimental  modal  analyses  were  performed  to  determine  the  dynamic 
behavior  of  each  substructure.  We  used  these  results  applying  CMS  to  de¬ 
velop  the  mathematical  model.  There  were  difficulties  to  be  overcome.  First 
was  the  problem  of  parameter  identification  to  accurately  scale  the  eigen¬ 
vectors  of  each  substructure  so  that  they  were  orthonormal.  This  involved 
special  curve-fitting  techniques  applied  to  transfer  functions  obtained  by 
test.  Another  important  difficulty  was  to  realize  that  an  ill-condition  may 
be  present  when  we  use  several  points  to  connect  2  substructures,  so  we 
developed  a  method  to  detect  this  problem  and  to  aid  in  correcting  it. 

The  model  had  to  be  validated  by  test,  and  it  was  done  for  two  different 
aspects:  the  quasi-static  case  and  the  dynamic  case.  For  the  quasi-static 
case  we  fixed  the  position  of  the  carriages  so  that  the  problem  became  time- 
invariant  and  then  we  compared  the  modal  characteristics  as  obtained  by 
testing  the  complete  robot  with  the  modal  data  calculated  by  the  model. 
The  average  error  in  natural  frequencies  for  the  first  17  modes  was  6.9%. 
The  second  aspect  of  the  validation  involved  running  the  carriages  according 
to  a  given  velocity  profile  at  the  motor  end,  and  recording  the  vibration 
at  the  end  effector  of  the  robot;  this  was  compared  to  the  prediction  of 
the  model  when  a  prescribed  motion  at  the  motor  end  (equal  to  the  one 
obtained  in  the  test)  was  imposed.  These  results  showed  an  acceptable 
agreement  between  the  predicted  results  and  the  test  results. 
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Figure  1.2:  Simply  supported  beam  with  moving  2-dof  subsystem 

1.2  Previous  Research  in  Modeling  of  Position- 
Dependent  Systems 

The  problem  of  studying  the  vibrations  of  a  position-dependent  system  in¬ 
volves  dealing  with  systems  of  continuous-parameter  elements  which  are 
described  by  partial  differential  equations  with  changing  boundary  condi¬ 
tions  as  the  elements  change  position.  This  situation,  already  difficult  to 
solve  for  the  case  of  ideal  elements,  becomes  worse  when  the  elements  are 
real,  that  is,  when  there  are  all  kinds  of  non-uniformities  present.  Then, 
an  exact  solution  is  very  cumbersome  and  for  practical  purposes  we  should 
use  a  method  that  gives  a  fast  and  accurate  solution. 

One  practical  approach  adopted  by  civil  engineers  in  the  case  of  the 
bridge  problem  is  explained  by  Biggs  [9],  where  it  is  tacitly  assumed  that 
the  system  is  slowly  varying,  and  they  use  one  point  of  connection  to  model 
the  contact  between  the  bridge  and  the  vehicle.  The  analysis  simplifies  the 
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single-span  bridge  structure  by  taking  it  as  a  simply-supported  beam;  the 
vehicle  is  taken  as  a  2-degree  of  freedom  system.  To  derive  the  equations 
of  motion,  assuming  one  mode  of  the  beam  only,  the  method  uses  the 
modal  equation  of  motion  for  the  beam  A„  -\-u\An  —  —  The  term 

/„  **»' '*n(*)iJd* 

F,  the  force  between  the  beam  and  the  2-degree  of  freedom  subsystem  is 
expressed  as  a  function  of  the  acceleration  of  the  mass  in  contact  with  the 
beam  (t/„),  (see  figure  1.2)  the  acceleration  of  the  second  mass(i)  and  the 
spring  force  ( k(z  -  yv))  in  the  2-degree  of  freedom  subsystem.  A  coupled 
set  of  differential  equations  in  yc  and  z  results. 

Since  the  problem  in  hand,  as  in  many  other  manipulators,  can  be  stud¬ 
ied  under  the  assumption  of  slowly-varying  coefficients  as  is  explained  later, 
we  can  extend  the  idea  behind  the  approach  for  the  bridge  problem.  We  first 
notice  that  in  the  method  mentioned  above  (bridge  problem),  the  dynamics 
of  the  2-degree  of  freedom  subsystem  are  introduced  to  the  beam  equation 
through  the  condition  of  equilibrium  of  forces  at  the  point  of  connection. 
This  idea  is  broadly  used  in  methods  of  connection  of  two  or  more  sub¬ 
structures,  namely  the  Impedance  method  [61  j  and  the  Component  Mode 
Synthesis  method  [33],  where  the  starting  point  is  the  specification  that 
the  vibration  of  any  two  points  of  connection  should  be  the  same.  Then, 
the  Impedance  method  substitutes  for  the  motion,  a  frequency  function 
whereas  the  Component  Mode  Synthesis  method  uses  a  function  of  time. 
These  methods  have  several  advantages  over  that  of  Biggs  [9].  They  can 
handle  several  points  of  connection  between  parts  and  they  can  work  in 
3-D  in  a  more  convenient  way  than  the  previous  approach.  In  addition  to 
that,  they  can  use  data  obtained  experimentally,  which  may  lead  to  a  more 
realistic  model. 

For  the  more  general  case  of  position-dependent  systems,  where  the  co¬ 
efficients  may  quickly  vary  during  the  vibration,  the  solution  may  be  found 
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if  a  pattern  of  vibration  is  repeated  for  each  cycle  of  the  oscillating  system. 
In  this  case  there  is  extensive  literature.  A  section  of  this  literature  is  re¬ 
lated  to  the  vibration  of  linkages,  and  for  some  simple  cases  the  differential 
equations  of  motion  reduce  to  Hill’s  equation  or  to  Mathew’s  equation.  One 
example  is  the  research  done  by  Capellen  [13]. 

A  method  for  analyzing  the  complete  behavior  of  industrial  robotic  ma¬ 
nipulators  with  flexible  links  and  including  the  control  systems  is  presented 
by  Sunada  and  Dubowsky  [73]  in  which  they  use  finite  element  models  to 
analyze  the  links.  The  method  is  made  computationally  efficient  through 
the  use  of  Component  Mode  Synthesis. 

For  the  case  of  the  robot  where  each  component  remains  invariant  but 
the  boundary  conditions  are  changing  with  position,  the  method  of  Com¬ 
ponent  Mode  Synthesis  may  be  more  adequate  for  giving  a  mathematical 
model  which  can  run  fast  in  the  computer  since  it  requires  extensive  pro¬ 
cessing  of  the  experimental  data  to  be  done  beforehand.  It  uses  only  the 
modal  results  for  the  components  in  the  model. 

1.3  Literature  Survey  on  Component  Mode 
Synthesis 

The  use  of  modal  characteristics  of  each  component  to  derive  the  approxi¬ 
mate  dynamic  behavior  of  the  assembled  structure  may  be  accomplished  in 
different  ways  as  summarized  by  Hart,  Hurty  and  Collins  [34].  These  meth¬ 
ods  can  be  grouped  in  three  categories.  The  first  is  Free-free  Modal  Synthe¬ 
sis  which  is  based  on  free-free  modes  of  the  components.  Hou  [33]  reviews 
these  methods  and  introduces  a  new  approach  which  is  adequate  for  han¬ 
dling  experimentally  determined  inode  shapes.  This  procedure  is  applied 
in  this  study  to  develop  the  mathematical  model  of  the  robot.  The  second 
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is  Component  Mode  Synthesis  which  uses  boundary- fixed  mode  shapes  and 
boundary  displacement  functions.  This  method  was  pioneered  by  Hurty 
[36]  where  natural  modes  and  frequencies  of  structural  systems  are  deter¬ 
mined  by  an  energy  method,  synthesized  from  admissible  mode  functions 
selected  for  the  component  mode  members  of  the  system.  The  synthesis  is 
accomplished  by  using  equations  of  constraint  that  follow  from  conditions 
of  force  equilibrium  and  deflection  compatibility  at  the  junctions.  Other 
authors  have  introduced  variations  to  the  method  [34], [16], [3].  All  these 
methods  are  very  effective  in  reaching  convergence  when  only  a  few  modes 
of  the  components  are  available.  The  third  category  is  Component  Mode 
Substitution  which  uses  free-free  modal  displacements  and  interface  loading 
at  the  attachment  points.  It  was  introduced  by  Benfield  and  Hruda  [4],  and 
it  has  the  advantage  of  improving  the  accuracy  obtained  by  the  free-free 
procedure. 

The  accuracy  of  the  model  for  the  free-free  case  depends  on  the  num¬ 
ber  of  modes  used. We  have  found  that  for  this  particular  application  the 
number  of  modes  required  to  get  a  good  convergence  index  can  be  easily 
obtained  by  test  (10  to  16  modes  for  each  component  including  the  rigid 
body  modes). 

Other  authors  have  surveyed  the  existing  literature  on  Component  Mode 
Synthesis,  Greif  and  Wu  [26]  summarize  the  work  done  from  1980  to  1983. 
Craig  [17]  surveys  some  of  the  many  variations  to  the  basic  procedure  of 
CMS  which  have  been  extensively  developed  during  the  past  20  years  for 
application  in  the  modal  analysis  of  complex  structures.  He  points  out  that 
further  research  on  damping  synthesis  and  the  use  of  experimental  data  to 
either  verify  or  formulate  CMS  mathematical  models  should  be  conducted. 

A  technique  for  modeling  a  stnicture  using  a  severely  truncated  mode 
set  is  developed  by  Hints  [32]  where  in  order  to  improve  convergence  he  uses 
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modes  (constraint  modes  and  attachment  modes)  based  upon  a  static  anal¬ 
ysis  of  the  component  structure  response  due  to  imposed  interface  forces 
and  displacements.  MacNeal  [52]  uses  statically  determined  deflection  in¬ 
fluence  coefficients  as  well  as  residual  flexibility  of  the  higher,  truncated 
modes  to  un  ove  accuracy.  Rubin  [67]  introduces  a  method  that  employs 
an  incomplete  set  of  free-boundary  normal  modes  each  adjusted  to  account 
for  the  contribution  of  residual(neglected)  modes.  This  method  adds  resid¬ 
ual  inertia  and  dissipative  effects  to  the  residual  flexibility  introduced  by 
MacNeal. 

On  the  use  of  attachment  modes  in  substructure  coupling,  Craig  and 
Chang  [18]  make  an  evaluation  of  the  methods  that  employ  attachment 
modes,  and  they  develop  a  generalized  substructure  coupling  procedure 
which  has  good  convergence  characteristics.  Hale  [27]  increases  accuracy 
by  an  iterative  procedure  for  generating  improved  substructure  trial  state 
vectors. 

Regarding  damping  synthesis,  there  are  a  few  analytical  studies.  Kana 
and  co-workers  [43], [44], [45], [46]  developed  three  methods  for  calculating 
proportional  substructure  damping  matrices  from  test  data.  Hasselman 
[30],  [31]  used  diagonal  and  off-diagonal  terms  to  develop  system  damping 
matrices  that  involve  various  substructure  coupling  procedures. 

The  use  of  experimental  data  to  develop  CMS  mathematical  models 
and  the  experimental  verification  of  the  simulations  has  been  reported  in 
a  few  papers.  Klosterman  and  Lemon  [47]  present  a  building  block  ap¬ 
proach  to  do  substructure  coupling  using  either  experimentally  obtained 
data  or  modal  data  obtained  by  Finite  Element  analysis.  They  applied  the 
method  to  complex  mechanical  machinery  consisting  of  5  components,  and 
used  6-7  elastic  normal  modes  for  the  most  flexible  ones.  They  emphasized 
that  the  higher  modes  that  were  left  out  in  the  truncation  had  a  residual 
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flexibility  which  had  a  considerable  influence  on  the  system  frequencies,  so 
they  included  this  effect  by  calculating  the  residual  flexibility  subtracting 
from  the  modal  response  representation,  near  the  antiresonances,  the  con¬ 
tribution  of  the  resonant  modes.  Then,  they  added  an  element  with  an 
equivalent  stiffness  derived  from  the  above  residual  flexibility  to  the  rest  of 
the  components.  Another  paper  by  Klosterman  [48]  applies  this  method  to 
a  complex  automotive  system. 

Among  other  works  on  the  use  of  experimental  data  we  can  mention  the 
one  by  Thoren  [75]  that  describes  a  technique  by  which  orthonormal  modal 
vectors  computed  from  dynamic  response  data,  are  used  to  derive  mass, 
stiffness  and  damping  matrices  for  a  discrete  model  of  a  distributed  elastic 
system.  The  same  problem  is  solved  by  Berman,  Wei  and  Rao  [7],  and  by 
Berman  and  Nagy  [6].  Ibrahim  [40]  presents  a  technique  to  use  a  set  of 
identified  complex  modes  together  with  an  analytical  mathematical  model 
of  a  structure  under  test  to  compute  improved  mass,  stiffness  and  damping 
matrices,  this  based  on  the  orthogonality  condition.  Berman  [8]  extends  the 
method  of  incomplete  models  and  uses  it  to  obtain  dynamic  equations  of 
motion  of  a  helicopter  transmission  gearbox  from  shake  test  data.  Goyder 
[25]  deals  with  structures  of  high  modal  density  and  reviews  methods  of 
mathematical  modeling.  Ewins  and  Sainsbury  [22]  develop  techniques  for 
obtaining  multidirectional  mobility  data  which  must  be  sufficiently  accurate 
and  complete  for  vibration  analysis  of  an  assembly  of  connected  structures. 

Considerable  attention  has  been  given  to  the  topic  of  convergence  of 
CMS  and  mode  selection.  Hurty  [37], [38], [39]  developed  a  first-order  per¬ 
turbation  technique  to  determine  the  contribution  of  truncated  modes  in 
the  natural  frequencies  of  the  assembled  system  as  obtained  by  his  method 
of  CMS.  Morosow  and  Abbott  [55]  determined  weighting  factors  to  assess 
which  component  modes  should  be  included. 
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1.4  Organization  of  the  Thesis 


The  thesis  introduction  describes  the  problem  we  are  dealing  with  and  the 
approach  followed  to  solve  it,  as  well  as  the  experiments  and  calculations 
performed.  It  discusses  the  existing  literature  on  the  topic  as  well. 

The  second  chapter,  Proposed  Quasi-static  Model  of  a  Cartesian  Robot, 
introduces  details  about  the  method  of  Component  Mode  Synthesis  and 
explains  how  the  mathematical  model  was  developed  for  the  homogeneous 
case,  that  is,  with  no  forcing  terms.  It  then  focuses  on  predicting  modal 
results  for  a  given  configuration  of  the  robot.  It  also  explains  the  difficulties 
encountered  with  the  orthonormalization  of  the  eigenvectors  and  with  the 
ill-conditioning  that  may  be  present  . 

The  following  chapter,  Proposed  Dynamic  Model  of  a  Cartesian  Robot 
introduces  the  forcing  terms  in  the  model  which  are  due  to  the  inertia  forces 
associated  with  the  acceleration  of  the  carriages  and  to  the  gravity  forces 
acting  on  a  changing  system.  At  this  point,  the  model  can  predict  the 
vibration  of  any  of  the  test  points  in  the  structure. 

Then  we  show,  in  the  chapter  of  Experiments  and  Results,  the  experi¬ 
ments  that  have  been  done  to  validate  the  model  and  the  degree  of  corre¬ 


lation  obtained  with  the  model  used. 


Finally  we  include  three  appendices  to  give  more  detail  about  the  data 
and  results.  Appendix  A  deals  with  the  mode  shape  data  obtained  for  each 
of  the  robot  components  as  well  as  for  the  assembled  robot.  Appendix  B 
gives  detail  about  the  vibrations  of  the  moving  robot,  in  particular  about 
the  method  followed  to  derive  the  forcing  function.  Appendix  C  shows 
a  preliminary  analysis  done  by  this  author.  This  work  gave  knowledge 
and  insights  on  how  to  deal  with  problems  of  systems  that  change  their 
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where  the  actual  vibration  would  be 

{*«}  =  W  {p«>  (2  2) 

{*i}  =  M  {Pb} 

If  we  enforce  compatibility  at  the  interfaces,  then  we  have  for  the  connec¬ 
tion  points  { xac }  =  {ar^}  or  [<&,J{p„}  =  \4>b,\{Pb)  where  the  subindex  c 
indicates  that  only  the  interface  points  are  being  used.  If  we  apply  these 
compatibility  conditions,  the  original  gcncraliased  coordinates  {pa}  and  {p*} 
are  ovcrconstrained  and  we  have  to  reduce  the  order  of  the  system  so  that 
we  end  up  with  a  set  of  linearly  independent  coordinates  {<7}.  We  can 
partition  these  vectors  and  the  modal  matrices  as  well 


M  =  ^  =  1  J  (2.3) 

1  {P?>  J  \  {rf>  J 

{Pfc}  =  {  Plb  }  =  {  9fc  }  (2-4) 

«]  =  [«!  Kl]  (2-5) 

[*.]  =  «!  (2-6) 

where  the  superscripts  I  and  D  stand  for  independent  and  dependent. 
Then, 

i  m  Ki  ]  ( 1 = ki  <»>  w 


Rearranging  we  have 

{rf}  =  [-Kl  ■[<]  [«]''[<]  ]{ 

(  9b 

Finally  if  we  include  the  complete  vector  {p}  we  have 
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or  {p}  =  [T]{q)  •  This  matrix  [T]  is  the  transformation  matrix  that  con¬ 
nects  A  and  B. 

To  obtain  the  equations  of  motion  of  the  assembled  system  we  first 
combine  the  two  parts  as  follows: 


Pa  +  [«*£]  0  I  Pa  W  0  fa 

Pb  0  [wj]  |  p4  0  fb 

Substituting  {p}  =  [Tj{q}  and  then  premultiplying  by  [T]£  we  get: 


(2.10) 


m*  (71  ($}  +  |r]' 


°  [r]  {,}  =  |T]'  0  /o 

[wfc]  o  <t>\  fb 


(2.11) 


These  equations  are  now  coupled  and  after  solving  the  eigenvalue  problem 
of  this  pseudosystein  we  get  {w'}  and  [V>]-  Finally  for  the  assembled  system 
we  have  that  w  and  4>  are  given  by 


M  =  M 


(2.12) 


and 

M=  W  ,  °  [JIM  (213) 

[  0  M 

Notice  that  the  name  free-free  for  this  method  does  not  imply  that  the 
components  have  to  be  tested  on  a  free-free  condition(floating),  but  rather 
that  the  points  of  connection  of  the  components  should  be  free  during  the 
test(as  opposed  to  the  fixed-boundary  case),  while  the  other  points  can  be 
either  fixed  or  free. 

One  important  characteristic  of  this  method  (CMS)  is  that  it  can  ei¬ 
ther  use  mode  shapes  for  each  component  as  obtained  by  a  finite-element 
technique  or  the  mode  shapes  can  be  obtained  experimentally.  There  are 
complicated  cases  where  we  may  be  better  off  using  test  results  as  data  for 
CMS  in  order  to  get  a  good  model.  Another  important  advantage  of  CMS 
is  that  it  handles  data  in  matrix  form.  This  allows  us  to  tackle  complicated 
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Z,  measured  from  neutral  position 


Figure  2.1:  Two-dof  subsystem  moving  on  beam 

problems  with  many  degrees  of  freedom  at  the  connections  and  in  3-D  with 
ease.  This  CMS  approach  works  well  for  time- invariant  cases,  that  is,  when 
the  points  of  connection  are  always  the  same  and  each  component  remains 
invariant.  This  approach  can  be  extended  to  the  case  of  position-dependent 
systems  for  the  case  of  slowly-varying  coefficients  as  shown  below. 

Consider  the  following  example:  Suppose  we  have  a  bridge  problem  as 
explained  by  Biggs  [9]  and  illustrated  in  Figure  2.1.  We  will  here  develop  the 
equations  of  motion  for  this  system  using  CMS  methods  and  then  we  will 
compare  the  results  with  those  obtained  by  Biggs  through  use  of  another 
method.  The  bridge  is  modeled  as  a  beam  and  the  vehicle  as  a  2-degree  of 
freedom  system  traveling  at  constant  velocity  as  shown  in  Figure  2.1. 

Assume  that  MVh  slides  without  friction  and  always  in  contact  with  the 
beam.  Assume  also  that  the  time  Ti  =  l~,  required  to  travel  the  distance 
L,  is  much  larger  than  a  natural  period  of  oscillation  tn  :  rn  >>  tn  .  We 
can  conceive  two  time  scales  in  this  problem;  a  fast  time  t  that  follows  each 
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cycle  of  vibration  and  a  slow  time  r  that  follows  the  rigid  body  motion  of 
the  carriages.  This  variable  e  is  defined  as  the  ratio  of  the  slow  time  r  to 


the  fast  time  t  :  e  =  ~  ,  and  for  the  beam  problem  its  formula  is 


(2.14) 


or  in  other  words  €  is  the  ratio  of  the  period  of  the  dominant  mode  of 
oscillation  to  twice  the  travel  time. 

Assume  r  =  et  ,  then  i  =  vr  =  vtt  . 

2.1.1  Characteristics  of  the  beam 

Consider  the  first  mode  only  for  a  simply  supported  beam:  u ,  <t> a  — 

am  T  *  ft  =  0  • 

2.1.2  Characteristics  of  the  2-degree  of  freedom  sys¬ 
tem 

The  2-degree  of  freedom  subsystem,  free  in  a  1-D  space  has  the  following 
natural  modes:  =  0  ,  u2Bj  =  kv 


M  =  1  ' 

l  -CifcJ 

where  Cl  =  ,  and  C2  = 


(2.15) 


[fo\  = 


Mv,g 

(Mvs  +  M„  u)  g 


(2.16) 


2.1.3  Compatibility  condition 

At  the  connection  point  we  have  yVA  =  yVg  or 


\4>A'){Pa}  =  [4>  Dr  ] 


i 

bJ| 


m 

km 


1  -  Vv 


Sv* 
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B 
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Substituting  the  expression  for  [TJ  the  equations  of  motion  become: 


symmetric 


1  +  fc 


—  - vm  j  v 

+  bt  Mf,  "*■  ^»«)  s‘n  HET  S'n  ^l‘L 


symmetric 


<1i  1  j  9  (A/„,  +  Muu)  /J  sin  =ff* 


Jfc  hdxjl  1  Mk 
*u  MVJ. 


(2.20) 

To  compare  this  solution  with  the  one  provided  by  Biggs  we  must  determine 
yc  ,  the  vibration  at  the  midspan  of  the  beam,  and  z  ,  the  vibration  of  the 
mass  Mva.  These  are  obtained  by 


=  wmM 


Substituting  the  expression  for  [T]  and  solving  for  q  we  get: 


(2.21) 


?*  |  fnLMl  0  J  *• 

q2  J  '  2  (AC,  +  A/,,}  ^^sin^f  V®  J  1  z 


(2.22) 


Also,  the  second  time  derivative  of  q  is  given  by: 


I  mlMj.  V  Mi, 

2  r~2 


fei/S™**1  V^J  l  5 


fcv5?«"¥  0  * 


(2.23) 


l-fcv'SW  sin nr  °J  l  *  J 

Substituting  these  expressions  for  <?  and  9  and  premultiplying  by 


1  jf*  —  sin 

M,  ,  mL  L 


(2.24) 
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we  decouple  the  mass  matrix  and  finally  get 


1  +  ^A^sin2^ 


+  e2 


0 

Mv, 

0 


(2.25) 


These  equations  are  the  same  as  the  ones  obtained  by  Biggs  when  we  neglect 
all  terms  in  e  .  So,  the  method  of  CMS  gives  the  right  answer  when  e  <<  1 
which  is  the  case  for  systems  with  slowly-varying  coefficients. 


2.2  Modal  Representation  of  the  Robot  Com¬ 
ponents 

In  order  to  use  CMS,  each  component  of  the  robot  must  be  represented  by 
its  rigid  body  and  clastic  modes,  and  these  modes  must  be  tridimensional. 

The  robot  components  are  seven  as  can  be  seen  in  Figure  2.2.  They  are 
called  STR,X,Y,Z,MX,MYt  MZ  whose  description  is  given  below.  The 
cartesian  robot  is  mounted  in  the  Artificial  Intelligence  Laboratory  of  MIT 
in  building  NE43.  It  was  designed  and  built  by  a  team  of  students  under 
the  supervision  of  Prof.  Warren  P.  Seering. 

STR:  The  component  STR  is  formed  by  the  structure  that  holds  the  car¬ 
riages  and  it  also  includes  the  dynamics  of  the  Boor  on  which  it  is 
mounted,  that  is  the  9th  floor  of  Building  NE43  of  MIT.  This  struc¬ 
ture  has  on  its  top  part  two  parallel  ways  which  guide  the  Y-carriage 
when  it  moves.  This  structure  is  formed  by  6  pieces  joined  together  by 
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long  and  thick  bolts  so  that  a  large  torque  can  be  applied  to  tighten 
them,  thus  avoiding  any  creep-friction  problem  that  would  introduce 
nonlincaritics  in  the  vibration  analysis. 

Component  X:  The  component  X  is  the  X-carriage  which  moves  in  the 
X-direction;  it  is  supported  by  the  ways  of  the  Y-carriage  and  it 
supports,  in  turn,  the  Z-carriagc.  When  it  moves  it  is  acted  upon  by 
the  motor  MX  through  a  lead  screw. 

Component  Y:  The  component  Y  is  the  Y-carriage  which  moves  in  the 
Y-dircction;  it  is  supported  by  STR  and  it  supports,  in  turn,  the 
X-carriage.  It  is  acted  upon  by  the  motor  MY  through  a  lead  screw. 

Component  Z:  The  Z-component  is  the  Z-carriage  which  moves  in  the 
Z-direction  and  is  supported  by  the  X-carriage.  It  is  acted  upon  by 
the  MZ  motor  through  a  rack  and  pinion  transmission. 

The  component  STR  being  fixed  to  the  floor  does  not  have  rigid  body 
modes,  but  the  rest  of  the  components  do  have,  and  to  calculate  them  it 
is  necessary  to  know  the  mass  and  inertia  properties  which  are  shown  in 
Table  2.1. 

Before  calculating  the  rigid  body  modes,  it  is  necessary  to  specify  the 
points  on  the  structure  to  be  measured.  These  points  must  include  at  least 
the  connection  points  of  the  components,  and  for  the  case  of  the  parts  that 
have  ways  that  slide,  we  take  as  many  points  along  the  ways  as  possible. 

The  rigid  body  modes  are  six  in  general,  three  rigid  body  translations 
along  X,Y,  and  Z  directions  and  three  rigid  body  rotations  about  those  3 
axes.  It  can  be  shown  that  these  modes  produce  translations  in  the  z,y 
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and  x  directions  which  arc  given  by  the  following  formula: 


(2.26) 

where  M  is  the  mass  of  the  component,  lx  is  the  moment  of  inertia  about 
its  center  of  gravity(XC9,  with  respect  to  the  X-axis  and  so  forth. 

4>xn  represents  the  mode  shape  value  of  a  point  with  coordinates  (X,  Y,  Z) 
along  the  X-direction  for  mode  n.  4>Vn  corresponds  to  direction  Y,  and  so 
forth.  6 1„  to  S6n  are  Kronecker  deltas  which  have  the  value  of  zero  unless  n 
coincides  with  the  first  subscript,  in  which  case  they  take  the  value  of  one. 

The  above  formulas  are  correct  when  the  principal  axes  of  the  compo¬ 
nent  are  aligned  with  the  X,Y,  and  Z  axes  but  if  they  axe  not,  then  one  way 
to  correct  this  is  by  calculating  the  mode  shape  values  along  the  principal 
axes  first,  and  then  rotating  them  to  coincide  with  X,Y,  and  Z. 

The  mass,  moment  of  inertia  and  position  of  the  center  of  gravity  can 
be  either  calculated  or  determined  by  test.  For  the  moments  of  inertia 
we  can  swing  the  component  as  a  pendulum  and  measure  the  period  of 
oscillation  To,  and  from  it  we  can  calculate  the  moment  of  inertia  by  means 
of  ICf  =  —jMgLTQ  —  ML2,  where  L  is  the  distance  from  CG  to  the  center 
of  rotation. This  method  seems  to  be  simple  to  use  but  it  is  very  sensitive 
to  errors  when  L  is  short  and  the  position  of  the  center  of  gravity  is  not 
precisely  determined.  Another  procedure  consists  in  using  flexible  strings 
to  obtain  a  rocking  motion  as  well  as  a  translational  motion  from  which 
the  moment  of  inertia  can  be  determined.  The  way  we  proceeded  was  to 
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do  analytical  calculations  of  the  moments  of  inertia. 

With  regard  to  the  elastic  modes,  each  of  the  components,  with  the 
exception  of  STR,  was  tested  on  a  free-free  condition,  that  is,  ’’floating” 
by  mounting  it  on  soft  foam  pads;  then  the  Impact  Test  was  applied  to 
a  series  a  test  points(the  same  used  for  rigid  body  modes),  and  the  mode 
shapes  obtained.  These  mode  shapes  can  be  expressed  as  arrays  where  the 
number  of  rows  is  the  number  of  degrees  of  freedom  (3  for  each  point  times 
the  number  of  points)  and  the  number  of  columns  is  the  number  of  modes. 

<t>ll  •  -4>ln 

0ml  •  •  0mn 

A  pictorial  representation  of  these  modes  (in  three  dimensions)  was  ob¬ 
tained  in  a  Structural  Dynamics  Analyzer  to  check  continuity  and  compat¬ 
ibility  of  the  modes  (to  find  out  if  there  were  bad  measurements). 

The  structure  STR  was  tested  differently  since  it  was  attached  to  the 
floor.  Here  the  modes  were  obtained  by  a  random  excitation  test  using 
an  electrodynamic  shaker.  The  test  points  along  the  ways  were  marked  at 
1-inch  apart  to  have  good  resolution,  since  the  Y-carriage  runs  over  them. 

The  frequency  range  for  each  of  the  main  components  varied  since  each 
one  had  its  own  frequency  interval  and  we  wished  to  have  a  minimum  of  5 
elastic  modes  of  each  component.  Table  2.2  shows  the  natural  frequencies 
determined  for  each  of  the  main  components.  The  mode  shapes  can  be  seen 
in  Appendix  A  . 

The  components  MX  and  MY  which  are  motors  coupled  to  lead  screws 
were  treated  in  a  special  way.  MY  is  mounted  on  STR  and  its  dynamics, 
other  than  torsion,  were  already  included  in  the  test  done  on  STR.  Similarly, 
MX  is  mounted  on  the  Y-carriage  and  it  was  tested  already,  except  for 
torsion.  So,  all  wc  needed  was  to  calculate  the  torsional  modes  of  MX  and 
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MY.  These  were  as  shown  in  Table  2.3.  The  component  MZ  has  a  short 
shaft  with  a  pinion  at  the  end,  and  it  was  modeled  as  being  rigid  in  torsion. 

The  modal  analysis  method  employed  by  the  Structural  Dynamics  An¬ 
alyzer  involves  curve  fitting  the  transfer  functions  to  determine  the  modal 
parameters  of  the  component.  This  technique,  which  calculates  eigenvectors 
by  assuming  the  existence  of  only  one  mode  at  a  time,  is  not  very  accurate, 
that  is,  it  does  not  give  correct  absolute  values  of  the  mode  shapes.  The 
relative  values  it  predicts  are  probably  more  reliable. 

In  order  to  normalize  the  elastic  mode  shapes  (for  unit  modal  mass),  a 
convenient  step  when  formulating  the  equations  of  motion  based  on  exper¬ 
imental  data,  we  proceeded  as  explained  in  the  next  section. 

2.3  Modal  Parameter  Identification 

When  a  modal  test  is  performed  on  a  structure,  we  obtain  the  natural  fre¬ 
quencies  and  some  scaled  version  of  the  mode  shapes.  This  information 
represents  a  family  of  dynamically  similar  structures,  and  it  is  not  until  we 
determine  the  right  scaling  factor  to  normalize  the  mode  shapes  that  we 
have  really  identified  the  particular  structure  under  test.  This  normaliza¬ 
tion  factor  is  difficult  to  obtain  with  accuracy,  when  working  experimen¬ 
tally,  because  we  have  to  make  assumptions  about  the  modal  damping  in 
the  structure  when  we  use  transfer  function  measurements.  So,  even  though 
there  are  many  algorithms  to  curve  fit  the  measured  transfer  functions  as 
discussed  below,  the  calculated  mode  shape  values  (or  scaling  factors  for 
normalization)  will  depend  on  the  algorithm  used,  and  there  is  an  impor¬ 
tant  variance  in  the  results.  This  in  turn  results  in  an  uncertainty  in  the 
predicted  results  of  CMS. 

There  are  a  number  of  ways  that  people  have  proceeded  to  normalize 
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the  mode  shapes  based  on  experimental  data.  One  simple  approach  used 
in  exact  analysis  of  continuous  systems,  which  may  work  for  structures  of 
simple  geometry  (like  a  uniform  beam  for  example)  consists  of  applying 
the  formula  for  normalization  of  a  continuous  beam:  C  =  —>  -- — —  « 

-  where  C  would  be  the  scaling  factor  to  get  the  correct  mode 

v£.  i 

shape  {<(>}  =  C{4>).  This  formula  can  be  extended  to  other  simple  shapes 


where  we  integrate  over  the  contour:  C  as  — 

vt:  , 

Another  procedure  to  find  the  correct  mode  shape  values  is  based  on 
multi-excitation  of  the  structure  [6GJ,  in  which  the  structure  is  excited  at 
several  points  simultaneously  in  such  a  way  as  to  excite  one  single  mode 
of  vibration;  then  the  vibration  is  measured  at  each  of  the  test  points  and 
that  vibration  gives  the  mode  shape  directly.  This  method  which  implies 
having  more  sophisticated  equipment  was  not  used  in  our  laboratory. 

The  most  common  method  used  is  based  on  a  drive-point  transfer  func¬ 
tion  measurement  [77],  which  in  our  case  was  obtained  with  high  frequency 
resolution,  and  then  a  curve-fitting  technique  was  applied  to  it  to  extract 
from  each  mode  its  modal  parameters.  One  of  the  formulas  for  the  drive- 
point  transfer  function  is  : 

n  _(A2 

rr/  \  4  2  .  n  .  V  **  f  /  /n 


M  -  Aw2  +  B  +  y -  - 


(2.27) 


where  w  is  the  frequency,  A  and  B  are  parameters  appearing  in  Au2  which 
represents  the  contribution  of  the  higher  modes,  and  B  which  is  the  con¬ 
tribution  of  the  lower  modes.  Each  mode  has  three  parameters:  w*  is  the 
natural  frequency  in  rad/sec,  ft  is  the  modal  damping  ratio,  and  4>kk  is 
the  true  mode  shape  value  at  the  drive-point.  This  formula  assumes  the 
following  idealizations: 


•  Damping  is  linear  and  viscous. 
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In  order  to  get  these  modal  parameters,  different  algorithms  that  curve- 
fit  the  experimental  data  have  been  prepared,  some  of  them  assume  there 
is  one  dominant  mode  only,  and  they  compensate  for  the  other  modes 
assuming  these  are  far  apart.  In  this  single  mode  group  of  techniques  we  can 
mention  the  circle  fit  to  the  Nyquist  polar  plot  (real  part  vs  imaginary  part 
with  frequency  as  a  parameter),  the  quadrature  picking,  and  the  rational 
fraction  least  squares  [11]. 

Another  group  of  techniques  make  multimodal  curve  fits  to  the  trans¬ 
fer  function.  In  general  they  involve  a  large  number  of  iterations.  They 
may  also  have  problems  of  convergence  since  these  are  nonlinear  paramet¬ 
ric  fits  (linear  in  <t>\k,  nonlinear  in  w*  and  &),  and  an  iterative  procedure 
is  necessary.  Among  these  methods  we  can  mention  the  method  of  ratio¬ 
nal  fraction  polynomials  [11],  the  Marquardt  Algorithm  [54],  and  Global 
Fitting  [24].  Brown,  Allemang,  and  Zimmerman  [11]  describe  parameter 
estimation  techniques  that  can  be  used  to  determine  modal  parameters 
from  experimentally  measured  frequency  response  or  unit  impulse  response 
with  particular  details  on  multidegree  of  freedom  techniques.  More  [54]  dis¬ 
cusses  an  efficient  implementation  of  the  Levenberg-Marquardt  algorithm 
and  shows  that  it  has  very  strong  convergence  properties. 

The  way  we  proceeded,  which  was  easy  to  use  and  readily  available, 
was  to  utilize  a  Simplex  technique  that  minimizes  the  sum  of  the  squares 
of  the  residuals  (or  the  differences  between  the  data  and  the  correspond¬ 
ing  calculated  values  based  on  succesively  improved  parameters).  Caceci 
and  Cacheris  [12]  present  this  technique  of  curve  fitting  and  discuss  its 
application,  advantages  and  disadvantages.  The  Simplex  program  used  for 
curve-fitting  admits  any  function,  linear  or  nonlinear,  whose  coefficients  are 
the  parameters  to  be  determined.  We  used  equation  2.27  with  the  modal 
parameters  to  be  adjusted  u;t,  and  4>kk  with  n  varying  from  5  to  13 
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Figure  2.3:  Curve  fit  of  transfer  function 

according  to  the  component.  We  first  tried  to  determine  all  parameters 
simultaneously,  which  are  3n,  but  the  process  was  converging  so  slowly  (if 
at  all)  that  we  could  not  proceed.  Then,  taking  as  initial  values  for  these 
parameters  the  values  obtained  by  a  single-mode  curve-fitting  technique, 
we  applied  the  Simplex  method  to  the  determination  of  three  parameters 
at  a  time  (for  one  mode),  but  using  equation  2.27  with  all  the  modes  of 
interest.  Here  convergence  was  achieved  in  a  small  number  of  iterations. 
Then  we  proceeded  in  the  same  way  with  each  of  the  subsequent  modes, 
each  time  updating  the  corresponding  parameters.  This  procedure  tended 
to  converge  a  little  faster.  One  of  the  results  of  the  curve  fits  is  shown  in 
Figure  2.3. 
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Figure  2.4:  Detail  of  lead  screw  and  nut 

2.4  Physical  Connection  of  the  Components 

Before  applying  CMS  we  have  to  define  the  degrees  of  freedom  of  each 
connection,  that  is,  the  vectors  representing  the  motion  of  the  points  of 
connection.  This  depends  on  how  the  components  axe  physically  connected. 

When  the  carriages  are  constructed  to  form  the  cartesian  robot,  they 
are  connected  by  means  of  preloaded  cam  followers  that  run  on  straight 
bars  or  ways  as  illustrated  in  Figure  2.6  .  There  are  a  number  of  these 
connections  between  each  mating  pair  of  components  as  can  be  seen  in 
Figure  2.5.  With  regard  to  the  connection  of  the  lead  rcrv.-ws,  there  is  a 
special  nut  mounted  on  the  component  to  be  moved,  wit^  lubricated  balls 
inside,  thus  transforming  the  rotation  of  the  lead  screw  into  a  translation 
of  the  carriage,  (see  Figure  2.4). 

Since  the  cam  follower  acting  on  the  way  exerts  a  normal  force  (if  friction 
is  neglected),  we  can  consider  as  the  degree  of  freedom  in  that  connection 
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Figure  2.5:  Schematic  representation  of  physical  connections 
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schematic  representation 


Figure  2.6:  Cant  followers  on  ways 

one  coordinate  or  vector  perpendicular  to  the  way.  Friction  is  accounted 
for  by  putting  (in  selected  positions  only)  one  vector(degree  of  freedom) 
parallel  to  the  way.  The  nut  that  connects  to  the  lead  screw  is  represented 
by  a  vector(degree  of  freedom)  parallel  to  the  lead  screw  axis.  So,  the 
degrees  of  freedom  of  all  these  robot  connections  are  defined  as  schemat¬ 
ically  represented  in  Figure  2.7.  Notice  that  we  use  translational  degrees 
of  freedom,  but  not  rotational  ones.  Bending  moments  and  torques  are 
transmitted  between  two  components  by  using  several  degrees  of  freedom 
in  the  connection. 

Friction  was  included  as  a  friction  degree  of  freedom  because  the  pre¬ 
dicted  mode  shapes  of  the  synthesized  robot(without  friction  degrees  of 
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freedom)  showed  a  relative  motion  between  the  parts  which  was  not  ob¬ 
served  in  the  experimental  mode  shapes.  There  is  also  a  more  fundamental 
reason  for  including  the  friction  degrees  of  freedom;  a  Coulomb  friction 
force  opposes  motion  and  tries  to  equilibrate  forces  until  it  saturates,  that 
is,  when  its  static  limit  is  reached.  This  saturation  makes  its  behavior 
nonlinear  as  opposed  to  a  linear  spring,  for  example,  which  ideally  never 
saturates.  So,  if  we  assume  that  the  forces  never  reach  saturation,  and  that 
is  because  the  cam-followers  are  preloadcd  against  the  ways,  then  we  can 
say  that  the  friction  effect  is  like  a  bolt  joint  which  does  not  allow  slide 
motion  during  a  cycle  of  vibration.  Nevertheless,  to  avoid  redundancies  we 
introduced  only  a  selected  number  of  these  friction  degrees  of  freedom  just 
to  prevent  some  relative  motions  between  components  based  on  experimen¬ 


tal  results. 


2.5  CMS  Model  of  Connections 


After  deciding  what  distribution  of  degrees  of  freedom  can  represent  com¬ 
ponent  connections  and  having  the  modal  representation  of  those  individual 
components,  we  can  use  CMS  to  establish  the  compatibility  conditions  at 
the  interfaces  and  end  up  with  a  prediction  of  the  dynamic  behavior  of  the 
robot.  Figure  2.8  shows  a  schematic  view  of  the  connections  illustrated  in 
Figure  2.5  by  representing  each  component  with  a  box  and  each  connection 
with  an  ellipse.  The  numbers  inside  the  ellipses  are  the  numbers  of  degrees 
of  freedom  used,  whereas  the  numbers  inside  the  boxes  axe  the  number  of 


modes  used. 


The  compatibility  condition  is  the  starting  point  for  CMS.  It  says  that 
the  points  of  connection  of  two  adjacent  components  have  to  move  together 
in  the  same  way,  that  is,  x*,  =  xq,  •  A  slightly  different  condition  is  used 
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G)  *  0  Q  10  0  Q  0  10 


no.  inside  box:  total  no.  of  component  modes 

no.  above  arrow:  no.  of  generalized  coordinates  chosen  to  be  dependent 
encircled  no.:  no.  of  generalized  coordinates  chosen  to  be  independent 


Figure  2.8:  Box  diagram  of  Component  Mode  Synthesis 

when  we  describe  the  assemblies  MX  and  MY  (motor  and  lead  screw).  Here, 
the  motion  of  the  component  that  is  moved  by  the  lead  screw  is  equal  to 
the  sum  of  the  motion  of  the  supporting  component  plus  the  translational 
motion  of  the  nut  caused  by  rotation  of  the  screw,  that  is  xAl  =  xDl  +  xLl. 
For  example,  in  Figure  2.9  we  show  the  case  of  MY,  STR  and  Y.  Here,  if 
Y  moves  to  the  right,  it  may  happen  that  only  MY  rotates,  or  only  STR 
translates,  or  both  move.  But  in  any  case  the  sum  of  motions  of  STR  and 
MY  must  be  equal  to  the  motion  of  the  Y-carriage.  Something  similar 
happens  between  the  Z-carriage  and  X  and  MZ. 

The  mode  shape  data  of  the  components  can  be  defined  as  in  table  2.4. 
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Component  Massing)  C(i(nitn)  IXrv {Kg  -  m2 ) 


x  =  359 

X- carriage  17.556  y  =  451 

a  =  130 


i  =  185 

Y-carriage  25.4016  y  =  471 

z  —  74 


i  =  368 

Z-carriagc  12.2458  y  =  542 

e  =  -160 


0.3846  0.18006  I  0.25495 


0.8060  2.0194  2.108 


0.7404  I  0.7404 


Table  2.1:  Maas  and  Inertia  properties  of  Robot  Carriages 


Y-camage 


(displ)  -  (displ)  ♦  (displ) 

Y-«»rr  ^  *v  STS 

Rotation  converted  to  translation 


Figure  2.9:  triple  connection 
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Each  component  has  at  least  one  joint  (with  several  degrees  of  freedom) 
and  for  each  of  this  joints  there  is  an  associated  modal  matrix  for  which 
the  number  of  rows  is  the  number  of  degrees  of  freedom,  and  the  number 
of  columns  is  the  number  of  modes.  Notice  that  these  modal  matrices  are 
partitioned  in  such  a  way  that  the  first  submatrix  (sufix  R)  corresponds  to 
the  independent  generalized  coordinates,  and  the  second  submatrix  (sufix 
O)  corresponds  to  the  dependent  ones.  The  number  of  generalized  coordi¬ 
nates  for  each  component  can  be  seen  in  Figure  2.8.  The  encircled  numbers 
above  the  top  boxes,  and  the  ones  below  the  bottom  boxes  are  the  number 
of  independent  generalized  coordinates. 


Based  on  these  compatibility  conditions  we  can  establish  the  following 
matrix  equation:  ApD  =  Bp1,  where  [i4]{pD}  is 
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(2.28) 


and  [fl]{p7}  is 
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(2.29) 

From  this  equation  we  get  the  dependent  elements  of  the  generalized  coordi¬ 
nates  pD  as  a  function  of  the  independent  ones  pl .  Then,  the  transformation 
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Component 


Fixed  structure  (STIt) 


X-carriage 


Z-carriage 


Dali  screw-motor,  Z-direction 


Modal  matrix 

Size 

(FSTRR.1  FSTROl] 

8  x  13 

[FSTRR2  FSTR()2| 

1  x  13 

(FXA1R) 

10  x  10 

(FXA2R) 

10  x  10 

(FXA3R) 

1  x  10 

[FXA4R] 

1  x  10 

[FYA1R  FYA10] 

8  x  16 

U22HS2SEHEH3I 

[FYA3R  FYA30) 

1  x  16 

JFYA4R  FYA40] 

1  x  16 

(FZT1R  FZT10) 

10  x  11 

(FZT2R  FZT20J 

1  x  11 

(FMX1R  FMXIOj 

1  X  2 

[FMYlR  FMY10) 

1  X  2 

[FMZIOj 

1  X  1 

Size  Connection  (Figure  2.8) 


Table  2.4:  Modal  Matrices  of  Robot  Components. 
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matrix  which  is  implicitly  defined  by 


=  {T]{P1} 


(2.30) 


can  be  formed.  So,  by  following  the  procedure  already  described  in  section 
2.1  we  can  obtain  the  equations  of  motion  of  the  cartesian  robot,  which 
for  the  homogeneous  case  have  a  solution  described  in  terms  of  the  natu¬ 
ral  modes  of  vibration.  These  modes  were  synthesized  in  the  computer  on 
the  base  of  the  previous  analysis  and  then  transmitted  to  a  Structural  Dy¬ 
namics  Analyzer  in  order  to  take  advantage  of  its  display  capabilities;  thus 
we  were  able  to  see  a  3-D  representation  of  each  mode  shape  on  the  ana¬ 
lyzer  screen,  the  comparison  of  experimentally  determined  with  synthesized 
mode  shapes  could  be  conveniently  done.  Before  showing  some  of  these  re¬ 
sults,  we  should  discuss  some  issues  about  convergence  and  conditioning  of 
this  CMS  process. 

2.6  Convergence  of  CMS 

As  it  has  been  pointed  out  by  several  authors,  among  them  Bathe  [2],  the 
technique  of  CMS  makes  use  of  the  Rayleigh-Ritz  analysis  [2]  in  the  sense 
that  it  takes  as  the  Ritz-basis  vectors  the  eigenvectors  of  the  individual 
components  and  then  through  a  linear  combination  of  them,  it  gives  the 
best  solution  available  that  corresponds  to  those  basis  vectors.  This  is  only 
an  approximation  since  we  are  not  using  all  the  modes  of  each  component 
but  rather  we  have  truncated  by  establishing  a  finite  frequency  range  of 
study. 

To  understand  why  CMS  is  considered  a  Rayleigh-Ritz  analysis  and  un¬ 
der  what  conditions  this  is  true,  we  perform  the  following  analysis.  Suppose 

we  somehow  know  the  complete  mass  and  stiffness  matrices  of  the  assem- 
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bled  system  formed  by  the  substructures  A  and  B,  but  suppose  that  the 
eigenvalue  problem  is  too  large  to  be  solved: 

{«■][*]  =  A|M]i*]  (2.31) 


We  want  to  reduce  the  system  order  from  m  to  a  by  using  the  Ritz- 
basis  vectors  4>  (m  x  s).  In  so  doing,  we  are  trying  to  get  an  approximation 
to  <$,  call  it  <f>.  Put  [<t>\  =  [<i>\[x j  where  [arj  are  the  Ritz  coordinates  to  be 
calculated. 

Then  form  the  Rayleigh  quotient 


M) = 

n  ’  [*nivii*] 

which  becomes  after  substitution  of  $] 

E?=i  EJ=i 


where  [K]  =  [4>\T[K\[4> j  and  [M\  =  [<t>\T[M}{4>]  • 
Minimize  the  Rayleigh  quotient: 

dp(4>)  _  2m  Ylj=i  2 k  Xjfflij 

dxi  m 2 


(2.32) 


(2.33) 


(2.34) 


Use  p  =  £  to  get 

£*=i  xj (*t3  -  prn,})  =  0 /or  *  =  1,2,  ..*  (2.35) 

This  is  equivalent  to  the  eigenvalue  problem  [K][x]  =  p\M}\x\  of  reduced 
order  s  which  we  suppose  we  can  solve.  This  process  parallels  the  CMS 
process  as  illustrated  in  Table  2.5. 

From  this  analysis  we  conclude  the  following: 

•  The  Ritz  coordinates  [i]  are  the  same  as  the  product  [T][t/>j  in  CMS. 
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•  While  the  Rayleigh-Ritz  analysis  uses  any  set  of  Ritz- basis  vectors 
to  get  an  approximation  to  the  eigenvalues  and  eigenvectors  with  a 
precision  that  varies  according  to  the  good  choice  of  the  basis  vectors, 
CMS  uses,  in  most  of  the  cases,  the  most  adequate  vectors  (a  9et  that 
includes  the  first  n  modes  of  each  component),  although  the  use  of  a 
truncated  set  precludes  getting  the  exact  solution. 

•  As  the  number  of  modes  used  in  the  analysis  increases,  CMS  converges 
monotonically  from  above  in  one  of  the  fastest  ways  possible  since 
each  addition  of  a  Ritz-basis  vector  is  one  of  the  best  vectors  that  can 
be  added. 

•  In  the  Rayleigh-Ritz  analysis,  the  use  of  a  complete  mass  and  stiffness 
matrix  to  get  the  reduced  system,  and  then  the  application  of  a,  min¬ 
imization  process  to  the  Rayleigh  quotient  is  equivalent  to  applying 
compatibility  conditions  in  CMS.  Both  methods  lead  to  the  reduced 
system  of  equations  whose  eigenvalue  problem  solution  gives  the  Ritz 
coordinates  [ x ]  —  (T][V>)  • 

»  If  the  Rayleigh-Ritz  analysis  uses  as  basis  vectors  the  eigenvectors  of 
the  substructures,  then  it  leads  to  the  same  answer  obtained  by  CMS. 

•  In  practical  cases  [K\  and  [M\  are  not  known,  so  wc  do  not  apply 
Rayleigh-Ritz  analysis,  but  its  principle  is  implicitely  used  in  CMS. 

The  results  obtained  for  the  eigenvalues  and  eigenvectors  of  the  assembled 
robot  are  approximations  to  the  real  values,  and  it  has  been  shown  for  the 
Rayleigh-Ritz  analysis  [2 j  that  the  convergence  is  inonotonic  from  above, 
that  is,  the  more  modes  we  use  from  the  components,  the  closer  we  get 
to  the  real  results.  But  this  method  always  yields  eigenvalues  that  are 
higher  than  the  exact  ones.  The  rate  of  convergence  can  be  determined 
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Figure  2.10:  Convergence  of  1st  natural  frequency  with  number  of  modes 
used 

numerically  by  simply  comparing  two  sets  of  eigenvalues,  one  obtained  with 
a  given  number  of  modes  and  the  other  obtained  with  one  mode  less  for 
any  of  the  components;  then  we  can  determine  whether  the  convergence 
is  satisfactory  or  which  component  needs  more  modes.  To  illustrate  this 
convergence  rate,  consider  the  case  of  a  free-free  beam  whose  modes  are 
known  (see  Table  2.6).  If  we  connect  it  to  a  fixed  support  near  the  end  to 
have  a  pinned-pinned-free  beam,  and  we  compare  the  first  natural  frequency 
of  this  so  supported  beam  as  obtained  by  CMS  to  that  obtained  from  its 
formula  (see  Blevins  [10]),  we  can  see  the  effect  of  using  more  and  more 
modes  of  the  free-free  beam  as  is  shown  in  Figure  2.10. 

We  should  point  out  that  this  monotonic  convergence  from  above  can 
only  be  seen  when  the  modes  of  the  original  component  are  correctly  nor¬ 
malized.  This  can  be  done  exactly  in  theory,  but  in  practice,  as  we  have 
discussed  before  (section  2.3),  there  is  always  an  uncertainty  on  the  nor- 
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malization.  Therefore  this  convergence  pattern  may  be  (lifTcrcnt,  that  is, 
the  convergence  may  be  towards  a  set  of  eigenvalues  other  than  the  true 
values. 

2.7  Conditioning  of  the  Numerical  Process 

When  applying  CMS  to  connect  two  or  more  structures,  and  when  more 
than  one  point  of  connection  is  used,  an  ill-condition  may  arise.  Ill  condi¬ 
tioning  is  a  situation  in  which  a  slight  change  in  the  data  produces  a  big 
change  in  the  results. 

The  numerical  process  in  CMS  includes  the  inversion  of  a  matrix  (see 
equation  2.28)  plus  the  solution  of  an  eigenvalue  problem,  and  either  of  the 
two  or  both  operations  may  be  ill-conditioned.  To  detect  thi3  problem  we 
follow  the  procedure  described  below. 

Turing  [76)  describes  a  way  to  determine  the  conditioning  for  matrix 
inversion;  that  is,  given  the  problem  [^4] {x}  =  {6},  we  want  to  know 
what  effect  a  slight  change  in  {6}  produces  in  the  result  {z}.  It  is  found 
that  Ax,  =  ff^A&y  =  (A~l)tJAb}  ,  so  the  biggest  element  in  [>4]  ~ 1  de¬ 
termines  the  condition  number.  For  the  case  of  CMS,  where  we  have 
{pD}  =  [v4]'1([J31(p/}))  we  proceed  as  follows: 

•  Run  original  case  and  get  eigenvalues. 

•  Find  most  sensitive  degree  of  freedom  in  b  =  Bp1  by  finding  j  for 

biggest  =  M'1),,. 

•  Alter  mode  shape  value  for  most  sensitive  degree  of  freedom  of  B  by 
1  %  and  get  the  new  eigenvalues. 

•  Compare  corresponding  eigenvalues. 
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This  problem  of  ill-conditioning  was  present  for  an  early  model  of  the  robot 
joints  as  shown  in  Figure  2.11.  Two  of  the  degrees  of  freedom  in  the  X- 
direction  were  redundant,  and  when  connecting  the  robot  components,  the 
first  resultant  two  modes  of  the  robot  were  unexpectedly  high.  By  applying 
the  above  procedure  we  found  that  the  alteration  of  1  %  in  the  most  sensi¬ 
tive  degree  of  freedom  produced  2.07  %  and  1.47  %  change  in  these  two  first 
modes  respectively.  The  problem  disappeared  when  two  degrees  of  freedom 
in  the  X-direction  were  removed  (two  from  the  front).  Then  the  change  in 
the  two  modes  was  -0.04  %  and  0.03  %  and  the  natural  frequencies  were 
reasonable  as  expected.  This  elimination  of  two  degrees  of  freedom  in  the 
X-direction  did  not  affect  the  predicted  robot  eigenvalues  appreciably,  at 
least  in  the  frequency  range  of  interest. 

In  order  to  identify  possible  redundant  degrees  of  freedom  we  can  pro¬ 
ceed  as  follows.  In  3-D  there  are  at  least  6  degrees  of  freedom  to  be  used 
since  that  is  the  minimum  required  to  connect  two  rigid  bodies.  The  way 
these  degrees  of  freedom  are  distributed  can  not  be  arbitrary  since  they 
have  to  prevent  any  possible  relative  motion  (translation  or  rotation)  be¬ 
tween  the  connecting  parts.  If  the  bodies  are  flexible,  we  can  start  adding 
more  degrees  of  freedom  and  here  is  where  a  redundant  combination  may 
give  problems.  The  most  sensitive  degree  of  freedom  as  indicated  by  the 
largest  element  of  A~*  is  a  good  candidate  at  which  to  start  looking  for  re¬ 
dundancies.  In  the  case  of  the  robot,  an  explanation  of  why  an  ill-condition 
was  present  is  that  the  first  two  mode  shapes  (the  ill-conditioned  modes) 
are  like  a  rigid  body  rocking  on  torsional  springs  at  the  floor,  but  when 
we  connect  the  carriages  on  the  top  of  the  structure,  we  are  trying  to  infer 
from  a  distant  section  (top  of  the  robot)  what  this  addition  of  inertia  (of 
the  carriages)  will  produce,  and  this  addition  is  introduced  redundantly 
since  only  two  degrees  of  freedom  in  X-direction  are  necessary. 
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L  •  lead  screw-nut  degree  of  freedom 
f  -  friction  degree  of  freedom 
p  -  rack-pinion  degree  of  freedom 
R  •  pair  of  redundant  degrees  of  freedom 

Figure  2.11:  Redundant  degrees  of  freedom  causing  ill-condition 
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Figure  2.12:  Synthesized  mode  shape  1  of  robot 

2.8  Predictions  of  Quasi-Static  Model 

For  a  given  configuration,  that  is,  for  a  fixed  position  of  the  carriages,  vi¬ 
bration  can  be  described  by  means  of  the  natural  modes  of  the  system.  Our 
model  of  CMS  can  predict  those  modes  and  the  Structural  Dynamics  Ana¬ 
lyzer  can  display  the  motions.  Some  of  the  results  axe  shown  in  Figure  2.12 
and  Figure  2.13.  For  more  detail  and  comparison  between  predicted  and 
measured  mode  shapes,  see  Chapter  4  and  Appendix  A. 
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Chapter  3 

PROPOSED  DYNAMIC 
MODEL  OF  A  CARTESIAN 
ROBOT 

3.1  A  Procedure  to  Analyze  Systems  of 
slowly-varying  configuration 

Here  we  discuss  the  possibility  of  extending  the  method  of  CMS  to  systems 
which  have  equations  with  slowly  varying  coefficients,  which  is  the  case  of 
this  and  many  other  robots  as  discussed  below.  We  apply  this  method  to 
the  case  of  a  simply  supported  beam  with  a  2-degree  of  freedom  system 
traveling  on  the  beam  at  a  constant  speed.  Based  on  this  simple  example, 
we  attempt  to  justify  the  use  of  this  method  for  analysis  of  a  cartesian  robot 
and  we  discuss  the  significance  of  the  errors  resulting  from  the  associated 
approximations. 

As  discussed  in  Chapter  2,  in  the  example  of  a  moving  two-degree  of 
freedom  system  on  a  simply  supported  beam,  our  goal  is  to  apply  CMS 
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to  connect  the  robot  components  in  such  a  way  as  to  take  into  account 
that  some  of  the  points  of  connection  may  be  slowly  changing  with  time. 
We  do  this  by  putting  as  the  argument  of  the  eigenfunctions  of  the  linear 
bearing  surfaces  (ways)  some  function  of  time  that  describes  how  the  points 
of  connection  are  moving.  This  procedure,  as  it  was  applied  to  the  beam 
problem  is  valid  when  e  <<  1,  that  is  when  we  can  neglect  some  terms  in 
e  in  the  general  equations  of  motion.  For  a  typical  bridge  the  value  of  e 
falls  in  the  range  of  0.10  to  0.20.  In  the  case  of  the  robot,  these  parameters 
depend  on  which  direction  the  carriages  are  traveling,;  for  each  of  three 
directions  X,Y,Z  the  results  are  as  shown  in  Table  3.1.  Since  e  is  small,  we 
can  classify  the  cartesian  robot  as  a  slowly-varying  system;  so,  besides  the 
fact  that  we  can  neglect  some  terms  in  e  and  apply  CMS  directly  to  derive 
the  equations  of  motion,  we  can  make  further  use  of  the  slowly  varying 
characteristics  (if  desired)  to  find  approximate  solutions  to  the  equations 
in  an  efficient  way. 

There  is  a  well  developed  set  of  techniques  for  solving  such  problems 
in  close  form,  as  explained  by  Nayfeh  [57].  The  problems  may  be  multi- 
degree  of  freedom  and  can  contain  forcing  terms.  Nevertheless,  the  most 
straightforward  technique  to  solve  the  equations  is  by  numerical  integration, 
and  that  is  what  we  have  chosen  to  do  since  we  first  want  to  verify  that  the 
model  can  represent  the  real  system  with  reasonable  precision. 

3.2  Determination  of  Continuous 
Eigenfunctions 

As  mentioned  before,  the  relative  motion  between  carriages  is  constrained 
by  preloaded  cam  followers  that  run  on  linear  bearing  surfaces  or  ways, 
and  physically  speaking  this  motion  is  continuous.  On  the  other  hand 
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Figure  3.1:  Linear  interpolation  of  mode  shape  data 

the  test  points  that  describe  the  eigenfunctions  of  these  ways  are  discrete 
although  they  are  closely  spaced.  This  situation  makes  it  necessary  either 
to  interpolate  between  points  or  to  curve-fit  using  some  suitable  functions. 

We  first  tried  the  interpolation  techniques  because  they  are  easy  to 
use.  The  interpolation  assumes  that  the  test  points  give  exact  values  for 
the  eigenfunctions;  that  is,  that  there  is  no  error  involved  in  the  measure¬ 
ments.  This  of  course  is  not  the  case.  We  used  linear  interpolation  and 
cubic  spline  interpolation  for  calculating  the  mode  shape  values  at  the  con¬ 
nection  points,  and  to  evaluate  these  techniques  we  looked  at  the  resulting 
variation  of  the  1st  natural  frequency  of  the  robot  with  position;  this  vari¬ 
ation  should  be  smooth  and  could  be  checked  experimentally.  So,  we  found 
that  the  linear  interpolation  gave  an  irregular  modal  variation  as  shown 
in  Figure  3.1,  as  did  the  cubic  spline  interpolation(see  Figure  3.2).  From 
these  results  we  conclude  that  the  problem  must  involve  the  presence  of 


measurement  errors. 
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Direction 

Dominant  /n(Hz) 

Ways  Length  (in) 

max.  speedful/*) 

value  of  ( 

X 

12.4 

.279 

1.27 

0.18 

Y 

18.9 

.584 

1.27 

0.00 

Z 

48.4 

.152 

1.27 

0.08 

Table  3.1:  Typical  Values  of  e  for  Cartesian  Robot 


Figure  3.2:  Cubic  spline  interpolation  of  mode  shape  data 
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Next  we  tried  curve-fitting  the  eigenfunctions  over  the  test  points  on 
the  ways,  in  the  least  squares  sense,  in  order  to  smooth  out  the  errors. 
One  attempt  was  to  use  Chebyshev  polynomials  of  different  orders.  These 
polynomials  are  defined  by: 


T0(x)  =  1 

7\(x)  =  x  (3.36) 

Tnvi(x)  =  2xT„(x)  -  Tn-i 

and  they  are  orthogonal  polynomials  with  some  convenient  properties  for 
curve-fitting.  Figure  3.3  and  Figure  3.4  show  the  curve  fits  for  orders  3 
and  5  for  a  particular  case.  The  corresponding  modal  variations  are  shown 
in  Figure  3.5  and  Figure  3.6.  One  observation  on  the  use  of  Chebyshev 
polynomials  is  that  they  give  more  weight  to  the  end  points  of  the  ways 
which  is  an  undesirable  characteristic  because  good  data  may  be  difficult 
to  get  at  these  ends.  Examination  of  the  results  showed  that  the  modal 
variation  is  very  sensitive  to  choice  of  the  order  of  the  polynomial  fit  chosen. 


This  is  a  clear  indication  that  the  method  is  not  robust. 


Therefore,  we  chose  to  proceed  by  developing  a  method  to  fit  beam-like 
eigenfunctions  in  a  least  squares  sense  to  experimental  data  collected  on  the 
ways.  The  ways  can  be  considered  as  beams  whose  boundary  conditions 
have  to  be  defined.  If  the  beam  is  uniform,  the  eigenfunction  is  defined  by: 


<t>(x)  =  Ci  sin(/?x)  4-  Ci  cos(0x)  -f  C3  sinh(/?x)  +  C4  cosh(/?x)  +  Cs  (3.37) 


where  the  parameters  C\  to  C}  and  0  depend  on  the  end  conditions  of  the 
beam  and  x  is  a  coordinate  along  the  beam  (see  Appendix  C  for  details). 
Curve-fitting  this  function  to  the  data,  in  order  to  find  the  parameters, 
involves  doing  a  nonlinear  parametric  fit  (nonlinear  in  /?)  which  may  have 
multiple  solutions  depending  on  the  initial  guesses  for  the  parameters.  The 
method  used  was  again  based  on  the  Simplex  technique,  where  we  spec¬ 
ify  any  function  wc  want  and  the  sum  of  the  square  of  the  residuals  is 
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Figure  3.7:  Two  different  solutions  to  the  curve-fitting  of  mode  shape  data 
using  a  beam-like  eigenfunction 

minimized.  To  find  a  good  solution  we  have  to  do  several  curve-fitting 
calculations  using  different  initial  values  of  the  parameters  each  time,  and 
then  choose  one  result  that  has  the  minimum  standard  deviation.  Fig¬ 
ure  3.7  shows  two  different  solutions  to  the  curve-fitting  of  one  case;  notice 
that  the  best  fit  has  a  standard  deviation  of  5.3E-3  whereas  the  bad  fit  has 
9.6E-2.  Figure  3.8  shows  another  case  where  the  data  is  generally  good  and 
Figure  3.9  shows  the  case  where  there  is  noisy  data.  So,  the  idea  of  the 
equivalent  beam  smoothes  out  the  errors  and  at  the  same  time  introduces 
the  physics  into  the  problem.  When  these  beam- like  curve  fits  are  used  to 
connect  the  components  of  the  robot,  the  modal  variation  looks  reasonable 
as  expected(see  Figure  3.10)  . 

This  curve-fitting  technique  that  assumes  an  equivalent  beam  was  only 
used  for  the  cases  where  a  motion  normal  to  the  ways  would  occur.  For 

example,  if  the  axis  is  positioned  along  the  Y- direct  ion,  then  only  c^{x)  and 
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<£(z)  would  be  curve-fitted  with  beam-iike  eigenfunctions,  and  <f>(y)  would 
be  done  with  a  straight  line  which  would  be  a  good  model  for  tension  or 
compression  of  a  unifor  u  bar.  The  number  of  curve  fits  done  for  the  robot 
was  as  shown  in  Table  3.2. 

3.3  Equations  of  Motion 

There  are  four  different  levels  of  equations  involved  in  the  vibration  analysis 


of  the  robot.  These  are: 


{p}  +  [2^n]{p}  +  W]{p}  =  (^{F} 
H{?}  +  tcl{9}  +  (*lW  =  [T|^{F} 

{f}  +  [2  4-  [«*]<r}  =  mTm{F} 


(3.38) 

(3.39) 

(3.40) 

(3.41) 


The  first  level  or  equation  3.38  represents  the  real  vibrations  {z}  of  the 
robot  before  it  is  connected;  that  is,  when  each  component  vibrates  sepa¬ 
rately  in  an  isolated  way.  The  second  level,  or  equation  3.39  is  obtained 
from  equation  3.38  by  operating  with  the  modal  matrix  {<f>\  which  decou¬ 
ples  the  equations.  Equation  3.40  represents  the  connected  robot  and  it 
is  obtained  by  using  the  transformation  matrix  [ T ]  that  operates  on  equa¬ 
tion  3.39  to  connect  the  components  since  it  contains  the  compatibility 
conditions  (see  chapter  2).  These  equations  are  coupled  again.  Finally, 
level  4  is  the  decoupled  set  of  equations  3.41  that  is  obtained  from  equa¬ 
tions  3.40  by  operating  with  the  modal  matrix  [V’j-  To  transform  back  to 
{x}  when  we  know  (r)  we  can  use  the  following  equation: 


{*)  =  MiqMM 


(3-42) 


Before  describing  the  procedure  followed  for  the  solution  of  these  equations, 

wc  shall  discuss  the  driving  functions. 


m. 

$$ 

WMw 

iSiWji 


B 


H 


/,  /.  J 


yy$ 


7^77, 


CHAPTER  3.  PROPOSED  DYNAMIC  MODEL 


68 


3.4  Force  Analysis  and  Prescribed  Motion 

So  far  in  this  thesis  we  have  dealt  with  the  left-hand  side  of  the  equations, 
that  is,  the  part  that  describes  the  homogeneous  solution  of  the  system.  The 
right-hand  side  which  contains  the  forcing  terms  that  excite  the  system 
are  described  now.  When  the  carriages  move,  the  inertia  forces  and  the 
gravity  forces  acting  on  a  system  that  changes  configuration  tend  to  excite 
vibrations  on  the  structure,  and  so  the  forcing  terms  are  associated  with 
the  motion  of  the  carriages. 

In  order  to  leave  out  the  control  system  that  causes  the  motion,  and 
consider  only  the  structural  vibrations,  we  measure  the  motion  of  the  motor 
rotor  including  torsional  vibration  during  a  prescribed  robot  motion  and 
use  this  information  as  prescribed  motion  at  the  motor  rotor  to  drive  the 
equations  of  motion. 

With  regard  to  the  interface  between  the  carriages  and  structure  in  the 
model  we  can  do  the  simulations  in  two  different  ways: 

1.  At  a  given  instant  the  carriages  can  be  assumed  not  have  relative 
motion,  so  they  are  pinned  to  the  ways,  but  those  pins  are  slowly 
changing  with  time.  Here  we  subtract  the  rigid  body  mode  by  as¬ 
suming  that  the  carriages  are  rigid  and  calculating  the  reaction  forces 
that  occur  due  to  an  acceleration  equal  to  the  rigid  body  acceleration. 
These  reaction  forces  are  then  used  to  drive  the  equations  of  motion. 

2.  The  carriages  can  be  assumed  not  to  be  pinned  to  the  ways  so  that 
they  can  slide  in  the  direction  of  motion.  However  they  have  to  over¬ 
come  a  friction  force  which  acts  as  an  external  force  whose  value  we 
know.  Then,  at  the  end  of  the  move  we  set  this  force  to  zero. 

Since  this  second  alternative  does  not  require  knowledge  of  the  rigid 
body  acceleration,  which  strictly  speaking  is  not  known,  wc  have  chosen  to 
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do  the  simulations  of  the  robot  vibrations  using  this  second  method. 

3.4.1  Prescribed  Motor-rotor  Vibration 

In  this  procedure  we  eliminate  the  forces  exerted  by  the  motors  from  the 
equations  of  motion  in  favor  of  the  prescribed  vibration  which  acts  as  a 
’’forcing”  function  to  drive  the  system. 

The  problem,  besides  being  position-dependent  presents  limitations  in 
the  available  data,  that  is,  all  we  know  are  the  natural  modes  of  each 
component  and  a  series  of  complex  frequency  responses  from  which  the 
modes  were  calculated.  The  problem  may  be  solved  in  several  ways  as 
explained  in  Appendix  B,  but  the  one  that  we  consider  the  most  suitable 
for  the  characteristics  of  this  cartesian  robot  is  a  tune-domain  technique 
which  is  not  restricted  to  time- invariant  systems. 

As  we  have  discussed  in  Chapter  2,  the  application  of  the  compatibility 
conditions  in  the  CMS  method  leads  to  a  set  of  coupled  differential  equa¬ 
tions  (equation  2.11  ).  These  equations  represent  the  complete  cartesian 
robot,  and  they  are  driven  by  forces  exerted  by  the  motors  in  the  presence 
of  friction  and  gravity  forces.  These  equations  can  be  decoupled  first  for 
convenience  and  then  manipulated  to  eliminate  the  motor  forces  by  sim¬ 
ple  multiplications  by  constants  and  adding  together  different  rows  of  the 
system,  since  the  motor  forces  appear  in  linear  form.  In  doing  this  elimi¬ 
nation,  the  equations  become  coupled  again,  and  we  reduce  the  number  of 
equations  by  the  number  of  motor  forces  eliminated  (maximum  of  3  forces, 
one  for  MX,  one  for  MY,  and  one  for  MZ).  Consequently  we  must  add  new 
equations,  and  these  come  from  the  relations  between  the  variables  r  of 
the  assembled  system  and  the  real  encoder  positions  xmx<  xmy >  or  xmz  35 


follows 


xmx  =  [</>A/xl \T}W{r},  etc. 


(3,13) 
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where  [4>mx\  is  a  row  vector  coming  from  the  modal  matrix  evaluated  at 
the  motor  shaft. 

So,  by  adding  these  equations  wc  again  have  the  number  of  equations 
required  for  the  number  of  unknowns  ({r}).  The  resulting  equations  can 
be  represented  by 


(m<) 

rj 

’  (Cc)  ■ 

'  ' 

r\ 

’  (tfc)  ' 

ri 

{/-} 

r*2 

•  + 

0 

'  + 

0 

,  _  , 

XMX 

(MmW 

• 

0 

■ 

0 

■ 

XMY 

.  (*m«)(T)W) 

r„ 

0 

.  r »  . 

0 

.  r"  . 

XMZ 

(3.44) 


where  fc  contains  the  system  external  forces  other  than  motor  forces.  These 
equations  can  now  be  integrated  directly  to  find  {r},  and  from  there  the 
vibration  at  any  point  x  can  be  obtained  from  {x}  =  [^][T][t/»]{r}. 

Notice  that  we  have  differentiated  equation  3.43  twice  with  respect  to 
time  in  order  to  obtain  a  mass  matrix  which  remains  non-singular.  This  is 
a  convenient  situation  to  have  for  numerical  integration  of  the  equations. 
This  differentiation  of  equation  3.43  assumes  that  the  terms  in  4>  and  4>  axe 
negligible  compared  to  the  terms  in  f  and  r  respectively  which  is  correct 
for  a  slowly-varying  system.  For  the  vibration  analysis  of  the  moving  robot 
we  moved  it  always  in  one  single  direction  (X,Y,  or  Z)  to  simplify  the 
mathematical  manipulations. 

3.4.2  Friction  Considerations 

The  friction  force  plays  an  important  role  in  the  robot  vibrations.  This 
force  is  high  due  to  preload  in  the  cam  followers;  it  normally  represents 
about  15  percent  of  the  total  motor  force  during  motion. 

The  friction  force  has  been  measured  by  Benjamin  (5)  who  did  a  computer- 
controlled  experiment  on  the  cartesian  robot  to  determine  the  values  of  the 
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Figure  3.11:  Variation  of  friction  force  along  x-direction 

friction  force  along  the  X-direction  of  the  robot  for  different  positions  of 
the  X-carriage.  He  modeled  this  force  variation  by  a  straight  line  which 
was  fitted  to  a  number  of  points  obtained  experimentally.  His  results  are 
reproduced  in  Figure  3.11.  For  the  Y-direction  and  Z-direction  he  did  not 
report  any  results. 

A  simple  static  test  measuring  the  force  required  to  start  motion  was 
done  to  get  approximate  values  of  the  friction  force  for  fpur  different  posi¬ 
tions  along  the  ways  for  each  direction.  From  these  values  we  approximate 
a  position-dependent  function  that  describes  the  friction  force  for  any  of 
the  three  principal  directions. 

These  forces  are  used  in  the  model  in  an  attempt  to  simulate  what 
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physically  happens  during  the  motion.  We  assume  that  the  friction  force  is 
equal  to  the  saturation  value  of  friction  (follows  the  straight  line  variation) 
as  long  as  there  is  relative  motion  between  carriages  and  ways.  It  may 
happen  that  the  friction  forces  reverse  sign,  and  that  is  when  the  difference 
in  displacement  between  two  sliding  parts  changes  sign.  This  occurs  for  the 
case  of  motion  in  x-direction  when  :  [4>x  carriage\[T\[^>\  ~  [4>y -  carriage\[T\[r/>] 
changes  sign,  where  <f>x  carriage  >s  the  mode  shape  value  at  the  instantaneous 
slide  point  of  the  X-carriage,  and  <j>y  carriage  is  the  corresponding  value  of 
the  Y-carriage.  The  program  has  to  monitor  this  difference  and  adjust  the 
sign  of  the  friction  force  accordingly. 

As  soon  as  the  motion  stops,  the  friction  force  is  assumed  to  be  always 
fluctuating  between  the—  saturation  value  and  the  +  saturation  value  while 
not  allowing  any  relative  motion.  Under  these  circumstances  the  force  is 
no  longer  known.  To  cope  with  this  we  pin  the  carriage  to  the  ways  using 
friction  pins.  This  means  that  we  modify  the  model  by  connecting  the 
carriages  to  the  ways  at  the  end  of  a  simulated  move.  This  gives  a  slightly 
different  dynamic  behavior  of  the  structure.  In  practice  we  noticed  better 
correlation  with  the  experimental  results  when  we  simply  set  the  friction 
force  to  a  constant  value  during  the  move  and  zero  at  the  end  of  the  move; 
this  suggests  that  perhaps  there  is  a  little  backlash  in  the  nut-lead  screw 
connection. 

3.4.3  Conditioning  of  the  Encoder  Motion 

The  encoder  motion  is  used  as  a  prescribed  motion  at  the  motor  rotor 
to  drive  the  equations  of  motion.  The  optical  encoder  used  gives  a  dis¬ 
placement  (rotation)  function  which  is  stepwise  continuous  as  shown  in 
Figure  3.12.  This  displacement  when  used  without  any  conditioning  to 
calculate  velocity  and  acceleration  gives  strong  discontinuities  mainly  in 
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Figure  3.12:  Encoder  displacement 

the  acceleration  function  because  the  encoder  provides  discrete  rather  than 
continuous  information  (see  Figure  3.13  and  Figure  3.14).  To  avoid  these 
problems  we  have  to  filter  out  the  stepwise  characteristic  of  the  encoder 
measurements;  one  way  is  by  using  a  digital  filter. 

The  filter  considered  is  a  differentiating,  low-pass  filter  with  zero  phase- 
shift  which  besides  differentiating  the  encoder  displacement,  filters  out  the 
undesired  higher  harmonics. 

This  digital  filter  is  a  non-recursive  type  filter  because  the  filter  output 
is  calculated  explicitly  from  the  input  fm  by  means  of 


9m  —  ^  '  bnfm-r 


(3.45) 


where  6n  are  the  filter  coefficients.  This  summation  is  an  approximation  to 
the  convolution  integral  where  the  set  of  6n  constitutes  the  impulse  response 
of  the  filter.  These  coefficients  have  to  be  calculated  so  that  the  frequency- 
domain  effects  of  this  process  come  out  as  desired,  that  is,  the  desired 
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Figure  3.14:  Unfiltered  encoder  acceleration 

transfer  function  of  the  filter  Hd(jut)  can  be  approximated  by  some  H{ju) 
through  a  least  squares  process.  In  this  way  we  find  bn  for  n  in  the  interval 
[~N,N\. 

The  general  formula  for  the  coefficients,  as  given  by  Stearns  [72]  is 


6 "  =  HM*-**-  -N  <n<N 


(3.46) 


We  chose  to  design  a  filter  which  would  eliminate  all  frequencies  above 
130  Hz  (this  limit  being  set  by  the  first  10  modes  of  the  robot),  and  differ* 
entiate  the  displacement  history  twice  as  well.  An  algorithm  developed  by 


McClellan,  Parks  and  Rabiner  [51]  can  do  this  linear  phase  filter  design,  al¬ 
though  its  differentiation  is  of  first  order,  so  we  have  to  do  the  process  twice 
starting  with  displacement  to  get  acceleration.  The  number  of  points(N) 
was  63. 

The  impulse  response  obtained  for  this  filter  is  shown  in  Figure  3.15 
and  the  corresponding  Fourier  transform  is  shown  in  Figure  3.16,  where 
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Figure  3.15:  Impulse  response  of  digital  filter 

the  Nyquist  frequency  is  F  =  1500  Ha  which  corresponds  to  the  sampling 
time  t  —  0.67  ms  of  the  computer-controlled  experiment. 

The  application  of  the  digital  filter  to  the  encoder  data  gives  the  velocity 
and  acceleration  shown  in  Figure  3.17  and  Figure  3.18  respectively.  These 
data  were  collected  during  a  move  in  the  X-direction.  Note  the  component 
of  acceleration  at  87.5  Hz  which  corresponds  to  the  dominant  8th  mode  of 
vibration  (see  Appendix  A). 

3.5  Solution  of  the  Equations  of  Motion 

In  order  to  calculate  the  time  history  x  of  vibrations  at  any  of  the  test  points 
of  the  robot  we  can  integrate  equation  3.41,  truncating  to  a  convenient 
number  of  modes  if  we  want,  and  then  using  equation  3.42  we  can  transform 
back  to  real  coordinates.  This  transformation  has  to  be  done  at  each  step 
since  the  matrices  involved  in  the  calculation  arc  position-dependent.  Now, 
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Figure  3.18:  Filtered  encoder  acceleration 

if  we  want  to  have  a  fast  computer  model  to  integrate  these  equations,  we 
have  to  do  all  the  work  that  can  be  done  prior  to  the  integration,  so  that 
the  integration  itself  is  fast  and  can  hopefully  be  done  in  real  time.  For  this 
purpose,  three  computer  programs  were  prepared  to  solve  the  equations  as 
described  below: 

•  The  first  program  calculates  the  modal  parameters  at  discrete  points 
along  the  path,  say  at  every  10  mm. 

•  The  second  program  smoothes  the  modal  parameters  using  cubic 
splines  to  calculate  these  parameters  at  each  time  step.  These  two 
programs  can  be  run  prior  to  the  integration. 

•  The  last  program  integrates  the  equations  by  using  the  parameters 
derived  above  at  each  time  step.  It  integrates  equation  3.41  with  a 
4th  order  Runge-Kutta-Merson  algorithm.  Then  it  transforms  r  to  z 
to  generate  a  time  history  at  the  desired  test  points. 
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This  scheme  was  implemented  on  a  VAX  11/750  computer  and  the  ratio 
of  computation  time  to  real  time  was  40  to  1  when  wc  integrated  over  the 
first  10  modes  of  equation  3.41.  To  improve  this  speed  for  real  time  control 
purposes  we  could  proceed  in  a  number  of  ways,  for  example  using  a  faster 
computer  or  trying  to  use  fewer  equations  in  equation  3.41,  or  even  trying 
to  get  asymptotic  approximations  to  these  equations  with  slowly-varying 
coefficients,  but  this  is  beyond  the  scope  of  the  present  work. 


3.6  Some  Results  of  the  Dynamic  Model 

To  test  the  model,  a  series  of  experiments  were  conducted  on  the  robot 
which  are  explained  in  detail  in  chapter  4.  From  these  tests,  the  motion 
at  the  motor-rotor  for  the  cases  of  motion  along  the  X-direction,  or  Y- 
direction,  or  Z-direction  could  be  determined,  and  it  is  from  this  data  that 
we  can  prescribe  the  motion  of  the  carriages  to  run  the  dynamic  model. 
Figure  3.19  shows  the  vibration  at  the  end-point  (test  point  144)  of  the 
robot  when  the  carriages  are  moved  in  the  X-direction.  This  curve  is  a  time 
domain  representation  and  covers  the  whole  motion,  that  is  from  t  =  0  to 
t  =  0.57  s.  Figure  3.20  shows  the  robot  tip  residual  vibration  (t  =  0.57  to 
t  =  0.89  s).  Figure  3.21  shows  the  frequency  content  of  this  end  vibration. 
For  the  case  of  the  Y-direction  and  Z-direction  see  Chapter  4  where  we 
compare  these  simulation  results  to  the  test  results. 


Chapter  4 


EXPERIMENTS  AND 
RESULTS 


4.1  Objectives 

We  axe  trying  to  understand  how  a  time-dependent  system  vibrates  in  order 
to  be  able  to  control  the  vibration  and/or  design  the  system  in  a  better  way. 
For  this  purpose  we  have  developed  a  mathematical  model  which  must  then 
be  validated  by  test. 

There  are  two  classes  of  objectives  for  the  tests  described  in  this  thesis, 
one  is  that  we  need  modal  data  from  each  of  the  robot  components  to  be 
used  as  input  to  the  mathematical  model.  The  other  class  of  objectives 
is  the  mathematical  model  validation  which  should  evaluate  the  accuracy 
of  this  model.  The  modal  tests  which  were  done  to  gather  input  data 
are  briefly  mentioned  in  this  chapter,  but  fully  described  in  Appendix  A. 
In  contrast,  the  validation  tests  are  explained  with  more  detail  here,  and 
a  comparison  with  the  predicted  results  from  the  mathematical  model  is 
presented. 

Wc  will  discuss  four  different  types  of  tests.  The  first  two  provided  data 
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for  the  model;  the  last  two  were  used  in  verification.  The  tests  included 

•  Modal  tests  to  determine  natural  frequencies,  modal  damping  and 
mode  shapes. 

•  High-resolution  transfer  function  measurements  for  orthonormaliza¬ 
tion  of  eigenvectors. 

•  Measurements  of  modal  variation  with  position  of  the  carriages. 

•  Measurements  of  robot  vibration  when  the  carriages  arc  moving. 


4.2  Modal  Tests 

The  theory  of  modal  analysis  deals  with  two  kinds  of  modes,  normal  modes 
and  complex  modes.  The  type  of  modes  depends  on  the  damping  behav¬ 
ior  of  the  structure.  Caughey  [14]  presents  an  analysis  of  the  conditions 
under  which  a  damped  linear  system  possesses  classical  normal  modes.  He 
concludes  that  the  damping  matrix  must  be  diagonalized  by  the  same  trans¬ 
formation  that  uncouples  the  undamped  systems.  Meirovitch  [53]  gives  a 
modal  analysis  procedure  designed  to  handle  the  general  case  of  damping. 
The  modal  analysis  as  is  done  in  the  laboratory  with  the  use  of  digital 
equipment  may  utilize  either  of  the  two  methods,  although  in  general  real 
structures  should  be  analyzed  using  complex  mode  theory.  Ibrahim  [40] 
explains  the  errors  involved  in  the  normal  mode  approximation  to  complex 
modes,  concluding  that  even  for  lightly  damped  structures  this  approxima¬ 
tion  may  lead  to  large  errors.  Potter  [62]  and  Potter  and  Richardson  [63] 
explain  the  theory  of  complex  modal  analysis  showing  how  to  calculate 
modal  vectors  from  a  measured  transfer  matrix. 

With  regard  to  vibration  tests,  Mustain  [56]  shows  the  results  of  a  survey 
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and  Olson  [23]  discuss  the  historical  development  of  transient  test  tech¬ 
niques  utilizing  a  digital  computer.  Halvorscn  and  Brown  [28]  describe  the 
impact  procedure,  its  theory,  applications  and  limitations.  Ramsey  and 
Richardson  [65]  present  a  brief  review  of  modal  analysis  based  upon  the 
identification  of  modal  parameters  from  measured  transfer  functions.  They 
point  out  the  advantages  of  a  band  selectable  Fourier  transform  (zoom 
transform)  for  obtaining  increased  accuracy,  resolution  and  dynamic  range 
in  the  measurements.  Richardson  and  Kniskern  [66]  present  an  algorithm 
that  reduces  error  in  the  mode  vector  when  using  more  than  one  simple  row 
or  column  of  residue  data(  more  than  one  excitation  point  when  using  a 
shaker,  or  more  than  one  response  point  when  using  a  hammer).  Okubo  [59] 
analyzes  the  effect  of  nonlinearities  on  transfer  function  measurements  with 
impact  excitations.  With  regard  to  nonlinearities  in  Structural  Dynamics, 
Crandall  [19]  discusses  the  nature  of  nonlinear  structural  models  and  sur¬ 
veys  a  variety  of  nonlinear  response  phenomena  which  can  be  predicted  by 
such  models. 

For  the  modal  tests,  we  have  in  the  Acoustics  and  Vibration  Laboratory 
an  HP-5423A  Structural  Dynamics  Analyzer.  In  conjunction  with  measur¬ 
ing  instruments  to  determine  acceleration  and  force,  and  with  excitation 
means  like  an  electrodynamic  shaker  or  an  instrumented  hammer,  the  An¬ 
alyzer  provides  adequate  facilities  for  our  purposes.  This  Analyzer  assumes 
proportional  damping  when  doing  modal  analysis  calculations. 

The  vibration  tests  performed  on  the  robot  components  to  obtain  input 
data  for  the  mathematical  model  are  explained  in  detail  in  Appendix  A. 
Basically  we  obtain  from  4  to  10  elastic  modes  for  each  component,  which  in 
addition  to  the  corresponding  6  rigid  body  modes,  give  a  sufficient  number 
of  modes  for  the  model  to  provide  convergence. 

Of  more  interest  in  this  chapter  is  the  validation  test  performed  on  the 
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completely  assembled  robot  which  was  tested  in  the  configuration  shown  in 
Figure  4.1.  Here  the  X-carriage  and  Y-carriage  are  in  the  middle  of  their 
respective  way  paths,  and  the  Z-carriage  is  all  the  way  down.  The  test 
set-up  is  shown  in  Figure  4.2.  A  Bruel  and  Kjaer  clectrodynamic  shaker 
type  4801  with  mode  study  head  type  4814  was  used  to  excite  the  structure 
at  the  test  point  no.  145  in  the  -Z  direction  while  a  triaxial  accelerometer 
B  &  K  type  4340  was  used  to  transmit  acceleration  to  the  analyzer  via 
a  charge  preamplifier  B  &  K  type  2628.  The  force  was  measured  by  a 
Wilcoxon  impedance  head  attached  between  the  shaker  and  the  structure. 
For  each  of  the  test  points  where  the  accelerometer  was  attached,  and  for 
each  direction  (X,Y,  or  Z)  a  transfer  function  made  of  50  to  80  averages 
was  calculated  and  stored  in  the  analyzer.  The  frequency  range  was  0-200 
Hz  in  the  first  set  of  measurements,  and  0-25  Hz  in  the  second  set  with  a 
total  number  of  measurements  of  405  for  each  test. 

A  typical  transfer  function  is  shown  in  Figure  4.3,  and  the  natural  fre¬ 
quencies  and  modal  damping  factors  are  shown  in  table  4.1.  Here  in  this 
table  we  also  show  the  corresponding  predicted  values  obtained  by  the 
mathematical  model.  The  first  4  mode  shapes  as  obtained  by  test  are 
shown  in  the  top  part  of  Figures  4.4-  4.7  whereas  the  corresponding  pre¬ 
dicted  modes  are  shown  in  the  bottom  part. 

Comparing  the  experimental  and  synthesized  results  we  notice  that  the 
avtrage  error  in  the  first  17  natural  frequencies  is  6.9  %.  The  mode  shapes 
show  the  same  type  of  tridimensional  motion  for  both  sets  of  results. 

We  believe  that  this  agreement  is  close  enough  and  that  the  math¬ 
ematical  model  can  also  predict  the  modal  characteristics  for  any  other 
configuration  with  comparable  accuracy. 
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4.3  High-Resolution  Transfer  Functions 

The  HP  analyzer  calculates  transfer  functions  using  256  complex  numbers 
for  equally  spaced  frequencies  in  the  specified  frequency  bandwidth.  This 
resolution  can  be  increased  by  repeating  the  test  with  different  center 
frequencies,  and  so,  ending  up  with  several  transfer  functions  that  can  later 
be  collected  into  one  single  plot  outside  of  the  analyzer,  in  a  computer. 
We  transmitted  these  transfer  functions  to  a  PDP11/44  computer  through 
a  GPIB  interface.  The  resultant  high-resolution  transfer  function  which 
contains  detailed  information  around  each  mode  of  interest  can  be  used 
to  get  more  accurate  estimates  of  the  modal  parameters,  particularly  the 
mode  shape  value  for  orthonormal  eigenvector  as  explained  in  chapter  2. 

Two  of  the  robot  components  were  tested  for  these  high-resolution  trans¬ 
fer  functions;  the  robot  structure  (without  the  carriages)  attached  to  the 
floor,  and  the  Z-carriage.  Details  of  the  test  are  given  in  Appendix  A. 
One  of  these  curve-fits  for  the  Z-carriage  is  shown  in  Figure  4.8.  As  was 
discussed  in  chapter  2,  the  results  may  seem  accurate  but  there  is  an  impor¬ 
tant  variance  when  we  apply  different  curve-fitting  methods.  For  example, 
if  we  change  the  initial  conditions  of  this  nonlinear  parametric  fit  we  get 
the  curve  fit  shown  in  Figure  4.9  which  may  seem  a  very  similar  result  but 
the  mode  shape  values  differ  from  5  to  25  percent  depending  on  the  mode, 
and  that  happens  because  damping  changes  as  well  in  such  a  way  that  the 
combination  of  w*,  and  gives  another  solution  of  the  nonlinear  prob¬ 
lem.  Therefore,  this  difficulty  in  the  system  parameter  identification  may 
preclude  good  accuracy  of  the  mathematical  model. 


Frequency  (Hi) 


Frequency  (Hi) 

Figure  4.9:  Multimodal  curve  Gt  no. 2  of  transfer  function  of  Z-carriage 
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4.4  Modal  Variation  with  Position 


A  position-dependent  system  changes  its  modal  characteristics  as  it  changes 
configuration.  The  cartesian  robot  shows  slight  changes  when  the  rela¬ 
tive  position  of  the  carriages  change.  In  order  to  partially  evaluate  these 
changes,  the  robot  was  tested  in  different  configurations  obtaining  for  each 
one  a  single  transfer  function  which  may  show  at  least  the  variation  in 
natural  frequencies.  Table  4.2  shows  these  variation  for  the  1st  mode  as 
well  as  the  corresponding  calculated  value  from  the  mathematical  model. 


Table  4.3  shows  similar  results  for  the  second  mode. 


These  tables  (4.2  and  4.3)  and  the  set  of  mode  shape  plots  show  in  gen¬ 
eral  good  agreement  between  experimental  and  calculated  results.  Based 
on  this  and  on  the  results  of  section  4.1  we  can  generalize  the  validity  of 
the  model  to  the  whole  work  space  of  the  cartesian  robot.  Table  4.4  shows 
the  variation  of  the  first  ten  natural  frequencies  along  the  Y-direction  for 
different  positions  in  the  X  and  Z  directions  (calculated  from  the  model). 
The  values  of  Y  (mm)  represent  the  position  of  the  Y-carriage  as  measured 
in  the  global  system  of  coordinates. 


4.5  Vibration  of  Moving  Robot 


The  final  objective  of  this  thesis  is  to  be  able  to  predict  the  vibrations  of 
<my  part  of  the  robot  as  the  carriages  move,  and  the  experimental  results 
described  in  this  section  permit  evaluation  of  the  model  simulations.  Three 
different  experiments  were  carried  out: 


•  Motion  of  the  carriages  in  the  X-direction  only. 


Motion  in  Y-direction. 


Motion  in  Z-dircction. 
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Position  of  carriages 

fi  (Hz)  measured 

fi  (Hz)  predicted) 

X front''  Y middle ■  Zdcrwn 

11.80 

11.98 

X front*  Ylrft*  Zdawn 

11.22 

11.70 

X middle*  Y middle s  Zdmun 

12.30 

12.05 

^middle  i  VlefU  ^down 

10.94 

11.75 

Xmtdtilc i  J  * niddle  •>  Zup 

11.49 

12.27 

Table  4  2:  Modal  Variation  with  Position,  first  Mode. 


Position  of  carriages 

/2  (Hz)  measured 

/2  (Hz)  predicted) 

X front  i  Tmiddlet  Zdown 

18.90 

19.09 

X front)  Yleft i  Zdown 

19.03 

19.23 

X middle i  Yrmddlei  ^dawn 

18.85 

19.17 

Xfntddle*  Ylefti  Zdown 

17.97 

19.31 

X middle *  ^up 

18.82 

19.15 
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Table  4.4:  Variation  of  Natural  Frequencies  (Hz)  with  Position  for  the  First 

Ten  Modes,  according  to  the  model. 

X  back  Z  top 

Y=  422.28.  12.1  19.3  36.9  47.9  49.9  61.1  69.9  88.7  101.9  105.4 

Y=  578.07:  12.4  19.2  36.9  48.3  49.8  61.6  71.0  91.0  102.1  110.4 

Y=  733.85:  12.5  19.1  30.9  47.9  49.9  01.8  72.0  92.5  101.1  106.8 

Y=  889.64:  12.7  19.1  30.9  47.6  50.0  62.0  72.5  93.1  100.4  107.8 

Y=  1006.48:  12.9  19.0  36.9  47.2  50.1  62.1  72.9  93.5  99.8  108.1 
X  back  Z  middle 

Y=  422.28:  12.1  19.3  36.9  47.7  49.9  61.2  69.5  90.1  101.6  119.2 

Y=  578.07:  12  4  19.2  36.9  48.0  49.9  61.7  70.8  92.7  106.1  121.5 

Y=  733.85:  12.0  19.1  36.9  47.6  50.0  61.9  71.8  93.7  101.8  122.9 

Y=  889.64:  12  9  19.1  36.9  47.3  50.2  02.1  72.7  94.2  102.0  123.4 

Y=  1006.48:  13.0  19.0  36.9  46.9  50.3  62.2  73.2  94.3  101.7  122.5 
X  back  Z  down 

Y=  422.28:  11.6  19.3  36.9  47.5  49.4  61.0  67.3  89.5  99.7  121.3 
Y=  578.07:  11.8  19.2  36.9  47.8  49.6  61.4  68.7  91.8  103.9  124.2 

Y=  733.85.  11.9  19.1  36.9  47.4  49.7  61.6  69.7  92.2  100.5  126.2 

Y-  889.64:  12.1  19.1  36.9  47.0  49.9  61.7  70.5  92.4  100.7  126.9 

Y= 1006.48:  12.2  19.0  36.9  46.6  50.0  61.8  71.1  92.3  100.4  125.6 
X  middle  Z  top 

Y=  422.28:  11.9  19.3  30.9  47.3  49.2  00.9  74.7  89.5  100.6  118.0 

Y=  578.07:  12.2  19.2  36.9  47.4  49.3  01.4  75.9  92.3  101.2  121.1 

Y=  733.85:  12.3  19.1  36.9  47.0  49.4  61.6  76.5  94.3  101.6  120.5 

Y=  889.04:  12.4  19.1  36.9  46.6  49.5  61.7  76.9  95.4  101.4  119.6 

Y= 1006.48:  12.5  19.0  30.9  40.2  49.6  61.8  77.1  95.6  101.0  119.8 
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X  middle  Z  middle 

Y=  422.28:  12.2  19.3  3G.9  47.2  49.3  61.1  74.1  92.2  100.7  121.8 

Y=  578.07:  12.5  19.2  36.9  47.3  49.G  G1.5  75.5  95.4  102.G  122.3 

Y=  733.85:  12.G  19.2  36.9  47.0  49.7  61.7  7G.4  97.0  102.3  122.3 

Y=  889.64:  12.9  19.1  3G.9  4G.5  49.8  61.9  77.0  97.5  102.7  121.9 

Y=  1006.48:  13.0  19.0  36.9  46.1  49.9  62.0  77.4  97.1  103.1  121.6 

X  middle  Z  down 

Y=  422.28:  11.8  19.3  36.9  46.9  49.2  G0.9  73.0  92.4  100.9  121.3 

Y=  578.07:  11.0  19.2  36.9  46.9  49.3  61.3  74.4  95.0  103.3  122.3 

Y=  733.85:  12.0  19.2  36.9  46.5  49.5  61.5  75.4  96.4  103.0  122.0 

Y=  889.64:  12.2  19.1  36.9  46.1  49.6  61.6  76.1  96.1  102.9  121.6 

Y=1006.48:  12.3  19.0  36.9  45.7  49.6  61.6  76.5  95.4  103.2  121.4 
X  front  Z  top 

Y=  422.28:  11.5  19.2  36.8  46.1  48.7  60.5  75.0  87.6  101  2  117.2 

Y-  578.07.  11.6  19.1  36.9  46.1  49.0  60.9  76.1  90.8  101.9  120.5 

Y—  733.85:  11.7  19.1  36.9  45.8  49.1  61.1  76.3  93.1  102.4  121.9 

Y-  889.64:  11.7  19.0  36.8  45.3  49.2  61.1  76.7  93.9  102.1  123.1 

Y=  1006.48:  11.8  18.9  36.8  44.9  49.2  61.2  76.9  94.0  101.7  123.4 

X  front  Z  middle 

Y=  422.28:  11.9  19.2  36.9  46.3  48.9  60.8  75.4  89.9  102.2  115.2 

Y=  578.07:  12.1  19.1  36.9  46.2  49.1  61.2  76.8  93.8  102.8  119.1 

Y=  733.85:  12.2  19.1  36.9  45.9  49.2  61.3  77.0  96.2  102.6  120.1 

Y=  889.64:  12.4  19.0  36.9  45.5  49.3  61.4  77.4  97.2  102.8  121.3 

Y=1006.48:  12.5  19.0  36.8  45.1  49.4  61.5  77.6  9G.9  102.9  121.7 
X  front  Z  down 

Y=  422.28:  11.7  19.2  36.8  46.1  48.7  60.6  75.1  89.4  92.1  113.3 

Y=  578.07:  11.9  19.2  36.8  46.0  48.9  61.1  76.6  89.4  95.7  116.7 

Y=  733.85:  12.0  19.1  36.8  45.7  49.1  61.2  76.8  89.2  97.8  117.4 

Y-  839  64:  12.1  19.0  36. 8  45.2  49.2  61  3  77.4  88.2  99.2  U8.3 
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Each  test  gives  out  two  results,  the  vibration  of  the  end-cfTector  as  mea¬ 
sured  with  an  accelerometer,  and  the  motor-rotor  displacement  as  measured 
with  an  optical  encoder. 

The  dynamic  model  which  was  discussed  in  the  previous  chapter  may 
now  use  this  motor  motion  as  input  to  simulate  the  robot  vibrations,  and 
therefore  an  evaluation  can  be  done  by  comparing  the  experimental  to  the 
simulated  results.  This  comparison  is  shown  in  detail  below. 

4.5.1  Computer-Controlled  Tests 

In  order  to  get  information  about  the  robot  vibration  a3  the  carriages  are 
moving,  we  made  use  of  the  PDP11/23  computer  which  controls  the  robot 
to  interact  with  the  rest  of  the  instrumentation  as  depicted  in  Figure  4.10. 
This  set-up  is  the  same  used  by  Singer  [71].  The  motion  specified  to  the 
carriage  motor  (one  at  a  time)  is  controlled  by  a  PWM  pulse  width  modu¬ 
lated  amplifier  which  is  driven  by  the  computer  trying  to  follow  a  velocity 
profile  (linearly  increasing  during  the  first  half  and  linearly  decreasing  in 
the  second  half).  The  amplifier  drives  the  motor  and  receives  feedback  from 
it  to  correct  for  deviations  to  the  specified  motion.  The  real  velocity  profile 
(  Figure  4.11)  for  a  test  along  X-direction  shows  the  corrections  done  when 
compared  with  the  specified  profile. 

The  torsional  rigid  body  motion  and  superimposed  vibration  for  any  of 
the  three  motors  MX,  MY,  or  MZ  are  measured  by  an  incremental  optical 
encoder  HP  type  HEDS-6010  B08  which  transmits  data  to  a  microcom¬ 
puter  connected  to  the  main  computer.  These  data  can  then  be  transmitted 
to  a  bigger  computer  (VAX  11/750)  to  form  a  data  file. 

The  acceleration  at  the  end-point  (or  any  other  of  the  test  points)  is 
received  by  the  IIP  analyzer  in  the  usual  way,  but  the  trigger  is  again 
controlled  by  the  computer  through  a  D/A  converter. 
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Figure  4.11:  Actual  Velocity  Profile  followed  by  Controller. 
4.5.2  Vibration  Results  for  Motion  in  X-direction 


With  the  Y-carriage  in  the  middle  and  the  Z-carriage  down  we  rein  the  MX 
motor  along  the  X-direction  from  Xi  =  154  mm  to  X2  =  291  mm  with  an 
average  acceleration  of  0.176<?  and  an  average  deceleration  of  0.181g.  The 
resulting  motor  displacement  is  shown  in  Figure  4.12,  and  the  corresponding 
velocity  after  being  filtered  is  given  in  Figure  4.13. 

The  end-point  vibration  as  measured  by  an  accelerometer  pointing  along 
th:  X-direction  is  shown  in  the  top  part  of  Figures  4.14  and  4.15  (complete 
vibration  and  vibration  at  the  end  of  the  move,  respectively).  The  linear 
spectrum  of  the  end  vibration  is  shown  in  the  top  part  of  Figure  4.16.  The 
corresponding  results  as  obtained  with  the  mathematical  model  are  shown 
in  the  bottom  part  of  the  same  figures. 
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Figure  4.16:  Fourier  transform  of  vibration  of  end-effector  at  the  end  of  the 
move  for  motion  in  X-dircction  as  obtained  by  test  (top)  and  by  simulation 
(bottom) 


CHAPTER  4.  EXPERIMENTS  AND  RESULTS 


M 


Figure  4.17:  Encoder  displacement  during  motion  in  Y-direction 
4.0.3  Vibration  Results  for  Motion  in  Y-direction 

The  X-carriagc  was  positioned  in  the  middle  and  the  Z-carriage  down  when 
the  carriages  were  run  in  the  Y-direction  from  Y\  —  498  mm  to  Yi  =  683 
mm  with  an  average  acceleration  of  0.25?,  and  an  average  deceleration 
of  0.32?.  The  motor  displacement  and  velocity  are  shown  in  Figure  4.17 
and  Figure  4.18  respectively.  The  vibration  results  as  obtained  by  test  are 
shown  in  the  top  part  of  Figures  4.19  to  4.21.  The  corresponding  results 
for  the  model  are  shown  in  the  bottom  part. 

4.5.4  Vibration  Results  for  Motion  in  Z-direction 

With  the  X-carriage  and  Y-carriage  positioned  in  the  middle  we  ran  the 
Z-camage  from  Z\  =  -486  rnm  to  Zi  =  -372  mm  with  an  average  accelera¬ 
tion  of  1.51?,  and  an  average  deceleration  of  0.76?.  The  motor  displacement 
and  velocity  are  shown  in  Figure  4.22  and  Figure  4.23  respectively.  Here 
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Figure  4.18:  Encoder  velocity  during  motion  in  Y-direction 


the  encoder  displacement  was  filtered  using  a  cut-off  frequency  of  270  Hz 
because  the  test  was  of  shorter  duration  and  the  analyzer  could  sample  the 
resulting  vibration  with  a  larger  frequency  bandwidth.  The  vibration  re¬ 
sults  as  obtained  by  test  are  shown  in  the  top  part  of  Figures  4.24  to  4.26. 
The  corresponding  results  of  the  model  simulation  are  shown  in  the  bottom 


4.5.5  Comparison  of  Simulation  and  Experimental  Re¬ 


sults 


The  final  test  of  the  mathematical  model  is  in  these  dynamic  experiments 
where  the  robot  carriages  are  run  in  all  three  directions  and  several  mea¬ 
surements  are  taken  at  the  robot  end-effector.  A  careful  study  of  these 
results  as  compared  to  the  model  results  gives  the  following  general  obser¬ 


vations. 
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Figure  4.21:  Fourier  transform  of  vibration  of  end-effector  at  the  end  of  the 
move  for  motion  in  Y-direction  as  obtained  by  test  (top)  and  by  simulation 
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Figure  4.23:  Encoder  velocity  during  motion  in  Z-dircction 
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Figure  4.25:  Vibration  of  end-effector  at  the  end  of  the  move  for  motion  in 
Z-direction  as  obtained  by  test  (top)  and  by  simulation  (bottom) 
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Figure  4.26:  Fourier  transform  of  vibration  of  end-effector  at  the  end  of  the 
move  for  motion  in  Z-direction  as  obtained  by  test  (top)  and  by  simulation 
(bottom) 
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•  The  model  predicts  the  same  order  of  magnitude  of  the  results  and 
the  same  dominant  harmonics  in  the  spectra. 

•  The  encoder  acceleration,  after  being  filtered,  contains  the  dominant 
harmonics  which  are  excited  by  the  motor,  harmonics  which  in  turn 
reflect  back  to  the  excitation  when  the  motor  tries  to  maintain  a  given 
velocity  profile. 

•  The  system  responds  not  only  with  the  first  two  or  three  modes,  but 
rather  with  a  broad  band  of  freqitencies  which  may  be  excited. 

•  The  vibration  that  occurs  during  the  move,  in  the  direction  of  motion, 
follows  very  closely  that  of  the  motor  rotor.  The  end  vibration  how¬ 
ever,  has  its  own  characteristics  which  are  in  part  due  to  the  motor 
whose  forces  remain  active  in  order  to  fix  the  rotor. 

A  more  specific  discussion  about  each  of  the  motion  directions  is  given  now: 

Motion  in  X-direction 

•  The  vibration  during  the  move  and  the  end  vibration  as  measured 
by  the  accelerometer  shows  some  drift  which  if  corrected  would  make 
the  plot  of  experimental  data  look  more  like  the  calculated  vibration. 

•  The  end  vibration  has  a  peak-to-peak  amplitude  of  approximately 
0.30  g  for  the  test  case  and  0.24  g  for  the  calculated  one. 

•  There  are  two  dominant  frequencies,  one  at  12.3  Hz  and  another  at 
88  Hz  which  correspond  to  the  robot  modes  no.l  and  no. 8  as  shown 
in  Figures  ??  and  ??.  These  modes  are  clearly  excited  because  of 
their  predominant  X-direction  component  of  end  point  motion. 
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•  The  relative  amplitude  of  these  harmonics  as  seen  in  the  frequency 
spectra  of  Figure  4.16  tend  to  agree  for  both  cases,  experimental  and 
simulated. 

Motion  in  Y-direction 

•  The  vibration  during  the  move  shows  the  same  general  shape  for 
both  cases  with  a  peak-to-peak  envelope  amplitude  of  2.0  g  for  the 
test  case,  and  2.5  g  for  the  model. 

•  The  end  vibration  shows  for  the  test  case  an  envelope  of  0.85  g,  and 
for  the  model  case  an  envelope  of  1.2  g. 

•  The  dominant  frequencies  for  both  cases  have  the  same  general  ten¬ 
dency  as  shown  in  Figures  4.19  and  4.20.  The  two  most  important 
harmonics  occur  at  19  Hz  and  36  Hz,  and  correspond  to  the  robot 
modes  no. 2  and  no.3. 

Motion  in  Z-direction 

•  The  vibration  during  the  move  has  an  envelope  of  5.0  g  for  the  test 
case,  and  7.0  g  for  the  model  case,  the  difference  being  that  the  model 
responds  more  at  the  higher  dominant  harmonic  of  230  Hz. 

•  The  end  vibration  as  obtained  by  test  shows  more  drift  here  than 
in  the  previous  tests.  Damping  decay  is  also  more  visible  in  this 
direction. 

•  The  first  two  dominant  frequencies  in  the  end  vibration  are  115  Hz 
and  176  Hz  (perhaps  multiples  of  the  line  frequency,  60  Hz),  but 
in  general  all  harmonics  are  rather  uniform  in  amplitude  as  seen  in 
Figure  4.26.  The  spectra  in  both  cases  look  similar. 
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Chapter  5 

CONCLUSIONS  AND 
RECOMMENDATIONS 

5.1  Conclusions 

1.  The  basic  idea  behind  the  present  vibration  analysis  of  the  cartesian 
robot  is  the  connection  of  substructures  which  remain  time- invariant, 
and  whose  modal  characteristics  and  transfer  functions  can  be  read¬ 
ily  determined  either  experimentally  or  analytically.  For  analytically 
determined  data,  we  normally  use  a  finite  element  analysis  proce¬ 
dure  to  connect  the  substructures,  but  CMS  can  also  be  used.  For 
experimentally  determined  data,  the  classical  way  of  connecting  sub¬ 
structures  is  the  Impedance  method,  although  CMS  can  be  used  here 
also.  For  this  particular  problem,  the  position  dependency  eliminates 
the  possibility  of  application  of  the  Impedance  method,  and  for  the 
slowly-varying  case  CMS  and  FE  can  be  used.  The  relatively  com¬ 
plex  structure  of  each  component  and  the  physical  availability  of  the 
prototype  point  towards  the  use  of  experimental  data  for  getting  a 
more  realistic  model.  Therefore,  the  use  of  CMS  becomes  logical. 
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2.  The  fact  that  CMS  uses  modal  data  as  input  permits  us  to  process 
all  experimental  data  separately,  and  input  the  processed  data  to  the 
model  which  can  then  perforin  fewer  operations  to  predict  the  robot 
vibrations  in  a  fast  way.  The  matrix  handling  features  of  CMS  are 
very  convenient  when  a  relatively  large  number  of  degrees  of  freedom 
are  to  be  used  to  connect  the  substructures,  as  in  the  case  of  the 
robot. 

3.  The  extension  of  CMS  to  the  case  of  slowly-varying  systems  can  be 
done  when  the  speed  at  which  the  carriages  move  is  such  that  the 
time  spent  in  traveling  all  along  the  ways  is  much  bigger  than  a  typ¬ 
ical  natural  period  of  oscillation.  This  situation  allows  us  to  neglect 
terms  in  4>  and  4>  and  permits  a  simple  manipulation  of  the  data. 
The  example  of  a  traveling  2-degree  of  freedom  system  on  a  simply 
supported  beam  analysed  with  two  time  scales  in  Chapter  3  gives  an 
illustration  of  the  validity  of  these  approximations. 

4.  When  connecting  substructures  through  multiple  degrees  of  freedom 
it  may  happen  that  a  singularity  or  an  ill-condition  is  present.  Since 
the  CMS  process  involves  both  the  inversion  of  a  matrix  A  that  incor¬ 
porates  the  compatibility  conditions,  and  the  solution  of  an  eigenvalue 
problem,  a  bad  distribution  of  degrees  of  freedom  causes  the  eigenval¬ 
ues  to  vary  significantly  from  expected  values.  Furthermore  a  slight 
change  in  the  data  may  cause  a  large  variation  in  some  eigenvalues. 
This  can  be  avoided  by  detecting  those  redundant  degrees  of  freedom 
and  eliminating  them  or  changing  the  distribution.  A  technique  has 
been  developed  in  this  Thesis  to  detect  and  solve  these  problems. 

5.  Modal  parameter  identification  has  been  an  issue  when  we  want  high 
precision  evaluation  of  the  modal  parameters  based  on  oxperimen- 
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tal  data.  When  curve  fitting  from  a  transfer  function,  the  modeling 
technique,  no  matter  how  precise,  has  to  assume  a  kind  of  damp¬ 
ing  behavior  since  modal  damping  is  one  of  the  parameters  that  has 
to  be  determined.  This  damping  behavior  is  difficult  to  assess  with 
precision  and  this  is  where  we  have  an  important  source  of  error. 
The  procedure  developed  here  consists  in  taking  a  very  high  reso¬ 
lution  drive  point  transfer  function  by  zooming  about  each  mode  of 
interest,  and  then  curve  fitting  by  applying  the  nonlinear  formula  of 
the  multimodal  transfer  function  to  a  linear  programming  technique 
(Simplex)  that  minimizes  the  square  of  the  residuals. 

6.  The  compatibility  conditions  used  to  connect  structures  normally  es¬ 
tablish  simple  relations  like  x a  ~  zb,  but  for  some  cases  where  we 
have  a  motor  with  lead  screw,  or  just  a  motor  M  that  is  supported  on 
one  component  A  to  drive  another  component  B,  we  then  use  another 
relation  which  is  xA  -f  xm  =  ig.  This  relation  enforces  the  system 
kinematic  relations  and  the  force  equilibrium  as  well. 

7.  The  use  of  the  GPIB  interface  to  establish  communication  between 
the  HP  analyzer  and  the  PDP  11/44  computer  really  enhances  the 
capabilities  to  do  3-dimensional  analysis  since  it  allows  among  other 
things  use  of  an  animated  display  of  the  computer  predicted  mode 
shapes. 

8.  The  eigenfunctions,  determined  experimentally  for  a  number  of  dis¬ 
crete  points  along  the  ways  on  which  the  carriages  slide  ,  are  subject 
to  error  and  that  adds  bumps  to  the  simulated  ways.  To  smooth  this 
we  curve  fit  a  beam-like  eigenfunction  to  these  data  to  get  in  addition 
to  smoothness,  a  continuous  function  that  permits  a  faster  calculation 
of  the  mode  shape  value  at  the  point  of  connection  (eliminating  the 
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need  for  interpolation  in  real  time). 

9.  The  use  of  the  optical  encoder  motion  that  monitors  the  motor-rotor 
displacement  during  the  robot  operation  to  drive  the  equations  of 
motion  permits  us  to  disregard  the  control  system  in  the  vibration 
analysis.  After  a  computer-controlled  experiment  gives  the  encoder 
motion  as  well  as  the  real  vibration  characteristics  of  the  end  effector, 
a  computer  simulation  that  utilizes  the  proposed  mathematical  model 
can  be  run  using  as  input  this  encoder  motion. 

10.  A  dynamic  model  for  the  system  vibrations  that  normally  contains  as 
a  forcing  term  the  motor  force  can  be  manipulated  to  eliminate  the 
unknown  force  in  favor  of  the  encoder  motion  (displacement,  veloc¬ 
ity,  and  acceleration)  and  have  this  encoder  motion  drive  the  resulting 
system  of  coupled  differential  equations.  This  process  is  not  restricted 
to  time- invariant  systems  because  it  is  done  in  the  time  domain,  and 
it  is  simple  to  use  for  slowly- varying  systems.  The  elimination  of 
the  unknown  force  which  appears  in  every  equation  of  the  originr,1y 
decoupled  system  is  performed  by  combination  of  equations  that  in¬ 
volve  multiplication  by  constants  (from  eigenvectors)  and  additions, 
plus  the  incorporation  of  an  extra  equation  involving  the  encoder 
motion. 

11.  The  arrangement  of  computer  programs  to  do  the  analysis  is  such  that 
the  simulation  program  receives  the  data  in  its  simplest  form,  having 
already  being  processed  by  previous  programs  so  that  the  real-time 
simulation  can  run  efficiently.  This  fast  program  however  is  still  40 
times  slower  than  the  real-time  process  when  running  on  a  computer 
VAX/750  using  10  natural  modes  of  vibration. 

12.  The  results  of  the  mathematical  model  for  Gxed  configuration  show 
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that  the  eigenvalues  and  eigenvectors  correlate  relatively  well  with 
the  experimental  values.  The  difference  in  natural  frequencies  for 
the  range  0  to  200  Hz  is  6.89  %  average,  and  this  error  is  not  so 
much  affected  by  the  convergence  rate  of  the  CMS  which  behaves 
like  a  regular  Ritz  analysis,  but  it  is  more  affected  by  the  errors  in 
the  modal  parameter  estimation,  particularly  in  the  scaling  of  the 
eigenvectors. 

13.  The  results  of  the  mathematical  model  for  the  case  of  the  moving 
robot  show  that  the  vibration  follows  very  closely  the  encoder  ac¬ 
celeration,  and  this  in  turn  contains  in  its  harmonics  (among  other 
harmonics  introduced  by  the  control  system)  those  natural  modes  of 
the  robot  that  are  excited  by  the  motion.  A  comparison  of  experi¬ 
mental  and  calculated  vibrations  show  in  general  good  correlation  in 
magnitude  and  in  frequency  content. 

14.  With  regard  to  the  preliminary  work  of  the  four-bar  linkage,  one  anal¬ 
ysis  that  illustrates  the  nature  of  the  position-dependent  problems,  or 
in  other  words,  of  changing  boundary  conditions  is  the  rocker-beam 
analysis.  Here  we  studied  the  behavior  of  the  first  natural  frequency 
as  the  boundary  conditions  changed,  having  obtained  the  limiting 
cases  of  cantilever  beam,  pinned-pinned,  clamped-pinned  and  free- 
pinned  beams. 

15.  Another  result  of  the  four-bar  linkage  problem,  the  linearization  of 
the  equations  of  motion  by  neglecting  higher  order  terms  leads  to  a 
parallel  analysis  in  the  moving  2-degree  of  freedom  system  on  a  beam 
which  allowed  extending  the  method  of  CMS  to  position-dependent 
problems. 

16.  Finally,  the  dimensional  analysis  for  the  four-bar  linkage  illustrates 
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that  dynamically  similar  systems  behave  in  the  same  way,  and  there¬ 
fore,  in  the  normalization  of  the  mode  shapes  for  the  robot  problem 
we  have  to  distinguish  the  right  member  of  the  family  which  belongs 
to  the  data  obtained  in  order  to  properly  identify  the  system. 


5.2  Recommendations 

1.  An  improved  technique  for  modal  parameter  identification  should  be 
pursued  to  more  closely  evaluate  the  modal  parameters,  particularly 
the  orthonormal  mode  shape  value  since  that  determines  most  impor¬ 
tantly  the  precision  of  the  final  simulation  results.  Different  damping 
patterns  should  be  examined,  and  solution  of  the  convergence  prob¬ 
lems  of  multimodal  curve  fits  should  be  tried. 

2.  Another  study  should  be. to  incorporate  the  control  system  to  the 
mathematical  model  in  order  to  have  a  complete  representation  of  the 
dynamic  system.  Again  CMS  may  be  used  to  connect  the  mechanical 
system  to  the  control  system  through  the  motors. 

3.  Another  study  which  would  make  the  model  more  precise  would  be  to 
add  corrections  to  first  order  to  the  differential  equations  by  restoring 
some  of  the  neglected  terms. 

4.  To  make  the  program  faster,  one  approach  that  could  be  tried  is  the 
asymptotic  approximations  to  the  solution  of  the  differential  equa¬ 
tions  by  curve-fitting  first  the  appropriate  data  and  then  apply  stan¬ 
dard  techniques  to  approximately  solve  differential  equations  with 
slowly-varying  coefficients.  The  solution  would  be  expressed  as  a 
function  of  position  and  of  the  motion  parameters. 

5.  Another  study  should  correct  the  mathematical  model  to  account 
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for  torque  reactions  that  occur  at  the  motor  base.  These  reactions 
may  affect  the  simulation  of  cross  vibrations  (vibrations  that  occur 
perpendicular  to  the  direction  of  motion). 
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Appendix  A 


MODE  SHAPE  DATA 

A.l  Determination  of  Modal  Characteristics 

The  vibration  analysis  to  be  performed  on  the  cartesian  robot  requires  the 
determination  of  the  natural  frequencies  and  mode  shapes  of  a  number 
of  structures  and  components,  some  of  them  being  rather  complicated  in 
shcipe.  These  parts  were  already  described  in  Chapter  2  and  include  the 
robot  structure,  the  carriages,  and  the  lead  screws.  As  mentioned  before, 
the  carriages  were  tested  in  a  free  condition  (floating)  by  suspending  them 
on  soft  foam-pads,  and  the  impact  test  was  applied  to  a  number  of  test 
points.  Also,  the  robot  structure  was  tested  while  bolted  to  the  floor  by 
exciting  it  with  an  electrodynamic  shaker  which  was  suspended  from  the 
veiling  with  a  flexible  string.  Finally,  the  torsional  modes  of  the  lead  screws 
were  obtained  analytically.  These  conditions  are  summarized  in  Table  A.l. 

The  random  test  using  a  shaker  is  more  precise  than  the  impact  test 
when  we  need  a  calibrated  measurement,  and  for  the  case  of  the  robot 
structure  attached  to  the  floor,  this  was  required  in  order  to  normalize  the 
eigenvectors.  For  the  Z-carriage  we  required  more  precision  than  for  the 
other  carriages  since  its  modal  characteristics  tend  to  affect  more  the  robot 
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vibrations.  Also,  its  modes  occur  at  higher  frequencies  when  tested  in  free- 
free  condition,  and  the  impact  test  can  not  give  good  results  above  800  Hz 
due  to  the  roll-off  of  the  impulse  force  spectrum. 

The  test  set-up  for  the  impact  procedure  is  shown  in  Figure  A.l.  The 
accelerometer  is  kept  fixed  at  one  convenient  test  point  and  the  structure 
is  marked  at  each  of  the  test  points.  The  instrumented  hammer  is  used 
to  impact  on  each  of  the  test  points  while  the  analyzer  collects  a  series  of 
transfer  functions.  This  process  can  be  repeated  for  a  different  position  of 
the  accelerometer  to  get  a  new  set  of  data  which  added  to  previous  set  could 
provide  a  more  complete  analysis;  that  is,  the  second  set  could  show  some 
of  the  modes  more  clearly  than  the  first  set.  But  strictly  speaking,  one  set 
of  tests  is  sufficient.  The  analyzer  can  then  process  all  these  data  with  an 
algorithm  that  determine!  .he  mode  shape  values  at  the  test  points. 

The  test  set-up  for  the  random  test  is  shown  in  Figure  A. 2.  Here  the 
shaker  is  kept  fixed  to  a  convenient  test  point  while  the  accelerometer  has 
to  be  moved  around  for  each  new  transfer  function. 

The  algorithm  used  by  the  analyzer  (HP  5423A  Structural  Dynamics 
Analyzer)  presents  two  options  to  the  user,  quadrature  picking  and  rational 
fraction  least  squares,  both  for  the  single  degree  of  freedom  case.  The 
quadrature  picking  or  line-method  is  useful  when  damping  is  low  and  the 
modes  are  closely  spaced  since  it  only  uses  the  transfer  function  value  at  the 
mode  peak.  The  rational  fraction  least  squares  or  band-method  curve-fits 
a  band  of  the  transfer  function  that  includes  the  mode  being  analyzed,  and 
it  is  more  precise  when  the  modes  are  well  separated. 

For  the  cases  of  very  simple  geometry,  like  the  lead  screws  in  torsion, 
we  can  analyze  them  by  the  theory  of  continuous-parameter  models,  par¬ 
ticularly  when  we  have  one  or  two  uniform  elements.  Then  the  analysis  is 
simple  .and  accurate. 
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Component  1  Tost 

Support  Cond. 

tost  points 

Structure 

random 

Hxed-fr<'e 

14C 

0-200 

13 

X-carriago 

impact 

free- free 

GG 

0-610 

4 

Y-carriagc 

impact 

free-free 

92 

10 

Z-carriagc 

random 

free-fr«*e 

54 

0-1500 

5 

MX-load  screw 

analytical 

fr<>e-froc 

continuous 

- 

1 

MY -lead  screw 

analytical 

free- free 

continuous 

- 

1 

MZ 

analytical 

free-free 

continuous 

- 

0 

Table  A.l:  Conditions  of  experimental  tests. 
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3-  50-  100.  150.  200. 


Frequency  (H») 

Figure  A.  10:  Drive-point  transfer  function  of  robot  structure 

A. 2  Mode  Shape  Data  for  Robot  Structure 

The  robot  structure  attached  to  the  floor  and  without  carriages  gives  the 
following  13  natural  modes  of  vibration  in  the  frequency  range  of  0  to  200 
Hz(see  Figures  A. 3-  A.9).  The  drive-point  transfer  function  which  was 
used  for  normalization  of  the  eigenvectors  was  obtained  by  zooming  about 
each  of  the  modes  and  then  collecting  all  these  transfer  functions  to  make 
one  single  plot  (see  Figure  A. 10).  This  figure  shows  a  collection  of  nearly 
2000  points  which  give  the  transfer  function  absolute  values  with  enough 
frequency  resolution  about  each  mode  of  interest.  The  curve  fitting  of  these 
data  was  already  discussed  in  section  2.3,  and  the  curve  fit  is  shown  as  a 
solid  line  in  the  same  figure.  From  this  curve  fit  we  determine  the  modal 
parameters  in  a  more  precise  way  than  in  the  standard  modal  analysis  , 
and  they  are  used  then  to  normalize  the  eigenvectors. 
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i 

A. 3  Mode  Shape  Data  for  Carriages 

All  three  carriages  were  tested  separately  in  a  free  condition  to  get  the 
elastic  mode  shapes  shown  in  Figures  A. 11-  A. 20.  The  rigid  body  modes 
were  calculated  as  explained  in  Chapter  2  . 

The  normalization  was  carried  out  in  two  different  ways  according  to 
the  modal  test  used.  For  the  Z-carriage  we  used  the  random  test  and  from 
it  we  got  the  drive-point  transfer  function  shown  in  Figure  A. 21  which  is  a 
collection  of  zoom  transfer  functions  about  each  mode.  We  then  curve-fit 
the  modal  parameters  as  explained  in  section  2.3. 

The  X-carriage  and  Y-carriage  were  tested  by  the  impact  procedure  (un¬ 
calibrated)  and,  then  to  normalize  we  used  the  mass  distribution  according 
to  a  formula  of  Chapter  2. 

A. 4  Mode  Shapes  for  Lead  Screws 

These  mode  shapes  in  torsion  were  obtained  analytically  by  modeling  each 
lead  screw  as  a  uniform  shaft  with  an  inertia  (motor  rotor)  attached  to  one 
end,  as  shown  in  Figure  A. 22.  The  natural  frequencies  for  this  system  are 
given  by  the  transcendental  equation 

srr{- f  =  (A-47) 

and  the  eigenfunctions  are  given  by 

a(x)  =  CiCos^iy^)  +  C2sin  (u/xy^)  (A. 48) 

To  normalize  we  use  orthogonality  of  the  normal  modes  to  get 

/  plv*l{x)dx  +  Ja\{L)  =  l  (A. 49) 

J  0 


Figure  A.  13:  Mode  shapes  no.l  (top)  and 
obtained  by  test 
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Figure  A.  15:  Mode  shapes  no. 5  (top)  and  no.6  (bottom)  of  Y-camage  as 
obtained  by  test 
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J 


l  p  Polar  moment  of  area  of  shaft 
J  Moment  of  inertia  of  rotor 

Figure  A.22:  Model  of  motor-rotor  and  lead-screw 

The  results  for  both  lead  screws  were  given  in  Table  2.3.  The  Z-carriage 
motor  MZ  with  its  short  shaft  and  pinion  is  essentially  rigid,  so  we  consid¬ 
ered  only  its  rigid  body  mode  in  torsion. 

A. 5  Modal  Matrices  for  Data  Input  to  Math¬ 
ematical  Model 

The  modal  matrices  to  be  used  in  the  mathematical  model  are  obtained 
from  the  mode  shapes  just  shown.  To  get  these  data  files  into  the  computer, 
we  transfer  data  from  the  analyzer  through  a  GPIB  interface  by  means  of 
a  computer  program  shown  in  Table  A.2. 

The  modal  matrices  are  formed  from  these  data  files  by  properly  scal¬ 
ing  them  in  order  to  normalize  the  eigenvectors.  If  the  correct  drive-point 
mode-shape  value  has  been  obtained  by  curve-fitting  the  drive-point  trans- 
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Tabic  A. 2:  Computer  programs  to  transmit  data,  back  and  forth,  between 

a  pdp  11/44  computer  and  an  HP  analyzer. 

C  TRAMOD.FTN 
C . * . *.**♦***.. 

c 

C  PROGRAM  TO  TRANSFER  HPS423A  MODAL  DATA  TO  THE 
C  PDP-11/44  VIA  THE  NATIONAL  INSTRUMENTS  GPIB11-1  INTERFACE. 

C 

(’  DATA  IS  TRANSFERRED  IN  ASCII  BY  A  501,4.2  SAVE  COMMAND 
C 

C  THE  OUTPUT  FILE  IS  FORMATTED  WITH  1  VALUE  PER  RECORD  (E15.7) 

C 

C  NOTE:  THE  IB:  HANDLER  USES  RSX  CHANNEL  1 

C 

C  SEE  CHAPTER  3  OF  VOL.  3  "USING  HP-IB"  (5423A) 

C 

£«•»*»*****«*»♦»***•**********• 

C 

BYTE  DDATA(630),  BSAVE(IO),  FILNAM(20),CSAVE(96) 

REAL  MDATA(999) 

IXTEGER*4  ASAVE(3) 

C 

C  501.4.2SA  IS  THE  SAVE  TO  CONTROLLER  COMMAND 
C  10  IS  THE  DECIMAL  VALUE  OF  THE  LF  TERMINATOR. 

C 

DATA  BSAVE  /  ’570\T,\’.’4’,\72\’S’,’AM0/ 

DATA  IWR,IRE.ICL.ITRJRM,ILO,IPO,ICO,IPC,IDE,IFI 
1  /0,  1,  2,  3.  4,  5,  6,  7,  8,  9,  10/ 

DATA  IHP,  ITA,  ILI  /"4,  "104,  "44/ 

C 

C  TELL  THE  OPERATOR  TO  PREPARE  THE  INTERFACE 

C 

TYPE  V  TRAMOD-  HP5423A  to  PDP- 11/44  data  transfer  program.’ 

TYPE  V  ’ 

TYPE  VI.  Connect  the  HP-IB  cable  from  the  PDP-lltotbeHP.’ 

TYPE  *.’2.  Set  the  HP  back  panel  switch  to  ’  ADDRESSABLEONLYV 
5  TYPE  *.’3.  Get  measurement,  data  on  the  active  trace  of  the  HP.’ 

TYPE  *.’4.  Enter  0  to  stop  or  1  to  continue  " 

ACCEPT  *,  J 

IF ( J  EQ.  0)  GO  TO  1000 

TYPE.*.’  5.  ENTER  MODE,  1ST  DOF,  AND  LAST  DOF;  ONE  AT  A  TIME’ 
ACCEPT  *.  ASAVE(l) 

ACCEPT  *.  ASAVE(2) 

ACCEPT  *,  ASAVE(3) 

NWRDS=ASAVE(3)-ASAVE(2)  +  1 
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C  FIRST  CLEAR  THE  BUS 
C 

10  TYPE  V  Initializing 
J  =  IBIJP(ICL,-1) 

IF(  J  .NE.  1)TYPE  V  BUS  CLEAR  FAILED,  ERR0R=’,J 
C 

C  MAKE  SURE  THAT  ANALYZER  IS  DEFINED  AND  ON  THE  BUS. 

C 

J  =  IBUP(  IDE.  IHP,  ITA,  ILI,  0,  0,  0,  0) 

IF(  J  NE.  1)TYPE  V  HP  DEFINE  FAILED,  ERROR=\J 
J  =  IBIJP(  ICL,  IHP) 

IF(  J  .EQ.  1)0, 0  TO  20 
C 

15  TYPE  V  TRY  AGAIN  ?  0=NO,  STOP;  1=YES 
ACCEPT  *,J 
IF(J  EQ.  0)  STOP 
GO  TO  10 
C 

C  ALL  SET,  SEND  501,4,2  SAVE  COMMAND 
C 

20  ILEN  =  10 

J  =  IBUP(  IWR,  IHP,  BSAVE(l),  ILEN) 

IF(J  .EQ.  ILENJGO  TO  30 
C 

C ERROR 
C 

25  TYPE  V  SAVE  COMMAND  FAILED,  REC=’,J,’  SENT=’,ILEN 
C 

C  SERIAL  POLL  TO  GET  SDA  SRQ 
C 

J  =  IBUP(  IPO,  IHP) 

TYPE  V  ANALYZER  SRQ  =  ’,J 
GOTO  15 
C 

C  START  READING  HEADER  (3  VARIABLES) 

C 

C  THIS  POLL  IS  NEEDED  WHEN  CONTROLLER  SENDS  SAVE  COMMAND 
C  THE  PROGRAM  WAITS  UNTIL  THE  ANALYZER  IS  READY  (SRQ=96) 

C 

30  ISAV  =  91 
DO  35  I  =  1,  2000 
J  =  IBUP(IPO,  IHP) 

IF(J  .EQ.  ISAVJGO  TO  38 
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Table  A. 2:  continued 


35  CONTINUE 

TYPE  V  TIMEOUT  ON  SAVSRQ,  HP  SRQ  =\J 
GO  TO  25 
C 

38  ILEN  =  32 
IOF  =  1 
ILAN=96 

ENCODE(ILAN.891,CSAVE(l))ASAVE(l),ASAVE(2),ASAVE(3) 
891  F()RMAT(3I5) 

J=IBUP(IWR.1HP,CSAVE(1),ILAN) 

C 

C  NOW  READ  IN  NWRDS  OF  (REAL)  DATA  TO  MDATA 
C  USE  BDATA(17-33)  AS  A  BUFFER 
C 

999  F0RMAT(E14.4) 

ILEN  =  32 

DO  50  I  =  1,  NWRDS 
J  =  IBUP(  IRE.  IHP,  BDATA(17),  ILEN) 

DEC0DE(  ILEN-2,  999,  BDATA(17)  )MDATA(I) 

TYPE  *N1DATA(I) 

50  CONTINUE 
C 

C  STORE  ON  DISK  FILE  IN  ASCII  (2  VALUES  /  RECORD) 

C 

60  TYPE  996 

996  FORMAT(’  Ester  filename  for  storage  :’,$) 

ACCEPT  995,FILNAM 

995  FORMAT(20A1) 

FILNAM(20)  =  0 
C 

OPEN(  UNIT=2,  NAME=FILNAM,  TYPE=’NEW’,  ERR=60) 

C 

WIUTE(2,994)  (MDATA(I), 1=1, NWRDS) 

994  F0RMAT(E15.7) 

CLOSE(UNIT=2) 

TYPE  997.FILNAM 

997  FORM AT( IX,  Ascii  data  and  header  stored  in  "\20A1,””) 
GO  TO  5 

1000  STOP 
END 
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Table  A. 2:  continued 


C" . * . . . . . . . . . 

C  TRARES2.FTN 

C  PROGRAM  TO  TRANSFER  HP5423A  RESIDUE  DATA  FROM  THE 
C  PDP-11/44  VIA  THE  NATIONAL  INSTRUMENTS  GPID11-1  INTERFACE. 

C 

C  DATA  IS  TRANSFERRED  IN  ASCII  BY  A  504,1  RECALL  COMMAND 
C 

C  THE  INPUT  FILE  SHOULD  BE  FORMATTED  WITH  1  VALUE  PER  RECORD  (E15.7) 

C 

C  THE  PROGRAM  TAKES  THE  40  VARIABLE  HEADER  FROM  THE  END  OF  THE  FILE 
C  AND  SENDS  IT  FIRST. 

C 

C  NOTE:  THE  IB:  HANDLER  USES  RSX  LOGICAL  UNIT  1 

C  SEE  THE  NATIONAL  INSTRUMENTS  "GPIB11  SOFTWARE  REFERENCE  MANUAL” 
C  FOR  INFORMATION  ON  USING  THE  BUS  FROM  FORTRAN  OR  ASSEMBLER 
C 

C  SEE  CHAPTER  3  OF  VOL.  3  "USING  HP-IB"  (5423A) 

C  FOR  THE  SAVE/RECALL  DATA  AND  HEADER  FORMATS 
C 

c . . . * . ****** . ***** . ••••**• . ****** 

c 

BYTE  BDATA(630),  BRCL(10),  FILNAM(20),CSAVE(96) 

REAL  MDATA(700) 

INTEGER*4  ASAVE(3) 

C 

C  504. IRA  IS  THE  RECALL  FROM  CONTROLLER  COMMAND 
C  10  IS  THE  DECIMAL  VALUE  OF  THE  LF  TERMINATOR. 

C 

DATA  BRCL  /  ,5,,’0V1V,V4,,V,,1*,’RVAM0/ 

C 

C  INSTRUMENT  BUS  UTILITY  PROGRAM  (IB UP)  FUNCTION  CODES 
C 

DATA  IWR.mE.ICL,ITRJRM,ILO,IPO,ICOTPC4DE,IFI 
1  IQ,  1,  2,  3,  4,  5,  6,  7,  8,  9,  10/ 

C 

DATA  IHP,  ITA,  ILI  /”4,  "104,  ”44/ 

C 

C  TELL  THE  OPERATOR  TO  PREPARE  THE  INTERFACE 
C 

TYPE  *,’  TRARES2-  HP5423A  from  PDP-11/44  data  tranaferprogram.’ 

TYPE  *,’  ’ 

TYPE  *,’l.  Connect  the  HP-IB  cable  from  the  PDP-11  to  thcHP.’ 
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Table  A. 2:  continued 


TYPE  *,’2.  Sot  the  HP  hack  panel  switch  to  "  ADDRESSABLEONLYV 

10  TYPE  *,’3.  Enter  0  to  stop  or  1  to  continue 

ACCEPT  *,J 

IF(J  .EQ.  0)  CO  TO  1000 

TYPE  *.  ’  4.  ENTER  MODE.  1ST  MEAS  AND  LAST  MEAS  |MAX  MEAS+4IF’ 
TYPE  VMODE.NE.O],  [(MAX  MEAS  +  1)*4  IF  MODE.EQ.O],  ONE  BY  ONE’ 
ACCEPT  *,  ASAVE(l) 

ACCEPT  *,  ASAVE(2) 

ACCEPT  *.  ASAVE(3) 

N  WRDS= AS  AVE(3)-ASAVE(2)+ 1 
C 

C  FIRST  CLEAR  THE  BUS 
C 

20  TYPE  Initialising 
J  =  IBUP(ICL,-1) 

IF(  J  .NE.  1)TYPE  BUS  CLEAR  FAILED,  ERROR=’,J 
C 

C  MAKE  SURE  THAT  ANALYZER  IS  DEFINED  AND  ON  THE  BUS. 

C 

J  =  IBUP(  IDE.  IHP,  ITA,  ILI.  0,  0,  0,  0) 

IF(  J  .NE.  1JTYPE  V  HP  DEFINE  FAILED,  ERROR=’,J 
J  =  IBUP(  ICL,  IHP) 

IF(  J  .EQ.  l)GO  TO  40 
C 

30  TYPE  TRY  AGAIN  ?  0=NO,  STOP;  1=YES 

ACCEPT  *,J 

IF(J  EQ.  0)GO  TO  1000 

GO  TO  20 

C 

C  GET  NAME  OF  ASCH  FILE  (1  VALUE  /  RECORD) 

C 

40  TYPE  999 

999  FORMATC  Enter  filename  for  transfer  (0=quit)  :’,$) 

ACCEPT  998.FILNAM 
998  FORMAT(20A1) 

IT  =  FILNAM(l) 

IF(IT  EQ.  48)  GO  TO  1000 
F!LNAM(20)  =  0 
C 

C  GET  NUMBER  OF  DATA  VALUES  TO  SEND 
C 

50  TYPE  997 
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Table  A. 2:  continued 


997  FOI?MAT(’  Enter  number  of  data  values  to  be  sent 
1’  512  for  trails  or  time,  250  for  coh 
ACCEPT  *,  NVAL 
C 

C  READ  DATA  AND  HEADER  FROM  FILE 
C 

D  DO  45  1=1,630 
D  45  BDATA(I)  =  0 

OPEN(  UNIT=2,  NAME=FILNAM,  TYPE=’OLD\  ERR=40) 

C 

READ(2,996)  (MDATA(I), 1=1, NVAL) 

99G  FORMAT(E15.7) 

CLOSE(UNIT=2) 

C 

C  CHECK  THAT  NWRDS  IN  HEADER  (VARIABLE  3)  =  2  *  NVAL 
C  THE  ENCODE  ROUTINE  TRANSLATES  FROM  DEC  INTERNAL  FORM  TO  ASCn 
C  THE  DECODE  ROUTINE  TRANSLATES  FROM  ASCII  TO  DEC  INTERNAL  FORM 
C  THE  LAST  TWO  CHARACTERS  ARE  CR,LF  WHICH  ARE  NOT  DECODED. 

C 

C  ILEN  =  16 
C  IOF  =  ILEN  *2+1 

C  DECODE(ILEN-2,  995,  BDATA(IOF)  )  BUF 
C995  FORMAT(E14.4) 

C  NWRDS  =  BUF 

C  1F(NWRDS  EQ.  2*NVAL)  GO  TO  60 
C  TYPE  *,’  **  ERROR,  NVAL  DISAGREES  WITH  HEADER’ 

C  GO  TO  60 
C 

C  ALL  SET,  SEND  501,4,1  RECALL  COMMAND 
C 

60  ILEN  =  10 

TYPE  Sending  501,1  recall  command...’ 

J  =  IBUP(  1WR,  IHP,  BRCL(l),  ILEN) 

IF(J  .EQ.  ILEN)GO  TO  80 
C 

C  ERROR 

C 

70  TYPE  RECALL  COMMAND  FAILED,  REC=',J,’  SENT=’,ILEN 
C 

C  SERIAL  POLL  TO  GET  SDA  SRQ 
C 

J  =  IBUP(  IPO,  IHP) 
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Table  A. 2:  continued 


TYPE  V  ANALYZER  SRQ  =  ’,J 
GO  TO  30 
C 

C  THIS  TOLL  IS  NEEDED  WHEN  CONTROLLER  SENDS  RECALL  COMMAND 
C  THE  PROGRAM  WAITS  UNTIL  THE  ANALYZER  IS  READY  (SRQ=121) 

C 

80  IRCL  =  121 
DO  90  I  =  1.  2000 
J  =  IBUP(IPO.  IHP) 

IF(J  EQ.  IRCLJGO  TO  100 
90  CONTINUE 

TYPE  V  TIMEOUT  ON  RECALL  SRQ,  IIP  SRQ  =\J 
GO  TO  30 
C 

C  START  SENDING  HEADER  (3  VARIABLES) 

C 

100  CONTINUE 

TYPE  Sending  measurement  header...’ 

ILEN=32 

IOF=l 

ILAN=96 

ENCODE(ILAN,891,CSAVE(l))ASAVE(l).ASAVE(2),ASAVE(3) 

891  FORMAT(3I5) 

J=IBUP(IWR4HP,CSAVE(1),ILAN) 

C  ILEN  =  16 
C  IOF  =  1 

C  J  =  IBUP(  IWR,  IHP.  BDATA(IOF),  ILEN) 

C  IF(J  .NE.  ILANJTYPE  V  FIRST  VARIADLE  TRANSMIT  FAILED,  J=’,J 
C 

C  SEND  THE  REST  OF  THE  HEADER  (VARS  2-37) 

C 

C  DO  110  I  =  2,  37 

C  IOF  =  IOF  +  ILEN 

C  TYPE  333.(BDATA(IOF+J-l),J=ULEN) 

333  F()RMAT(22A1) 

C  J  =  IBUP(  IWR.  IHP,  BDATA(IOF),  ILEN) 

110  CONTINUE 

C 

C  LAST  THREE  VARS  ARE  ASCII 

C 

C  IOF  =  IOF  +  ILEN 
C  ILEN  =  8 


i 
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Table  A. 2:  continued 


C  TYPE  333,(BDATA(IOF+J-l),J=l,ILEN) 

C  J  =  IBUP(  IWR,  IHP,  BDATA(IOF),  ILEN)  1INPUT  TRANSDUCER  MODEL 
C  IOF  =  IOF  +  ILEN 
C  TYPE  333, (BDATA(IOF+J-l),J=l, ILEN) 

C  J  =  IBUP(  IWR,  IHP,  BDATA(IOF),  ILEN)  'OUTPUT  TRANSD. 

C  IOF  =  IOF  +  ILEN 
C  ILEN  =  22 

C  TYPE  333, (BDATA(I0F+J-1),J=1, ILEN) 

C  J  =  IBUP(  IWR,  IHP,  BDATA(IOF),  ILEN)  !MEAS.  TITLE  20  CHARS. 

C  TYPE  994.(BDATA(IOF+I-l)  ,1=1.20), NVAL 

994  F0RMAT(1X,’  Title=  ”\20A1, Sending’,14,’  datavalues.’) 

C 

C  NOW  SEND  OUT  NVAL  OF  (REAL)  DATA  TO  THE  ANALYZER 
C  USE  BDATA(  17-32)  AS  A  BUFFER 

C  FINISH  EACH  VARIABLE  WITH  CR,LF  FOR  TOTAL  OF  16  BYTES  /  VARIABLE 
C 

BDATA(31)  =  13 
BDATA(32)  «  10 
ILEN  =  16 
993  FORMAT(E14.7) 

DO  120  I  =  1,  NVAL 

ENCODE(  ILEN-2,  993,  BDATA(17)  )MDATA(I) 

TYPE  *TMDATA(I) 

J  =  IBUP(  IWR,  IHP,  BDATA(17),  ILEN) 

120  CONTINUE 

TYPE  Operation  finished.’ 

GO  TO  10 

1000  CONTINUE 

STOP 

END 
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fer  function,  then  we  scale  the  eigenvector  by  pivoting  on  the  current  drive- 
point  mode-shape  value.  If  the  normalization  procedure  is  based  on  the 
mass  distribution  of  the  test  points  of  the  component,  then  we  determine 
C,  the  scaling  factor,  directly. 

Each  robot  component  was  tested  on  a  number  of  points  which  include 
the  points  of  connection  to  other  components.  These  test  points  are  marked 
all  over  the  contour  of  each  component  in  order  to  see  how  the  mode  shapes 
are.  For  data  input  to  the  mathematical  model,  we  only  need  the  points  of 
connection. 


A. 6  Mode  Shape  Data  for  Complete  Robot, 
Experimental  and  Predicted  Results 

The  robot  was  tested  for  the  configuration  shown  in  Figure  4.1,  that  is, 
with  the  X-carriage  and  Y-carriage  in  the  middle  and  the  Z-carriage  down. 
The  mode  shapes  in  the  frequency  bandwidth  of  0  to  200  Hz,  as  obtained  by 
experimental  test  using  a  shaker,  are  shown  in  the  top  part  of  Figures  A. 23- 
A.39. 

For  this  same  configuration,  we  have  run  the  mathematical  model  to 
predict  the  mode  shapes  of  the  robot;  the  synthesized  mode  shapes  are 
shown  in  the  bottom  part  of  Figures  A. 23-  A. 39.  A  comparison  of  natural 
frequencies  as  well  as  modal  damping  factors  can  be  seen  in  Table  A. 3. 
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Figure  A. 27:  mode  shape  no. 5  of  complete  robot  as  obtained  by  test(top) 
and  by  synthcsis(bottom) 
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Figure  A.31:  mode  shape  no. 9  of  complete  robot 


and  by  synthcsis(bottom) 
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Figure  A. 32:  mode  shape  no.  10  of  complet 
and  Hy  synthesis(bottom) 


Figure  A. 37:  mode  shape  no.  15  of  complete  robot  as  obtained  by  test(top) 
and  by  synthesis(bottom) 
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Figure  A. 39:  mode  shape  no.  17  of  complete  robot  as  obtained  by  test(top) 
and  by  synthesis(bottoiii) 
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Appendix  B 


VIBRATION  OF  MOVING 
ROBOT 


This  appendix  describes  the  method  of  analysis  employed  in  the  study  of 
robot  vibrations  during  motion,. method  which  has  been  used  in  Chapter  3 
to  do  the  simulations. 

B.l  Methods  of  Analysis 

After  briefly  mentioning  the  case  of  prescribed  rigid  body  motions  which 
provides  a  simple  approach  to  thv  problem,  we  then  discuss  in  some  detail 
the  procedures  that  can  be  used  for  the  case  when  the  motor- rotor  vibration 
is  specified. 

B.1.1  Prescribed  Rigid  Body  Motion 

As  was  discussed  in  Chapter  3,  one  of  the  simplest  approaches  to  the  prob¬ 
lem  of  predicting  the  robot  vibrations  caused  by  its  motion  is  to  prescribe 
how  a  particular  substructure  is  moving  (as  a  rigid  body)  regardless  of  the 
input  required  to  cause  t hat  motion,  thus  leaving  out  the  effects  of  the  robot 
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how  a  particular  substructure  is  moving  (as  a  rigid  body)  regardless  of  the 
input  required  to  cause  I  hat  motion,  thus  leaving  out  the  effects  of  the  robot 
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control  system.  In  order  for  this  procedure  to  be  simple  we  can  assume  for 
a  moment  that  the  substructures  are  rigid  and  calculate  the  forces  exerted 
at  the  connection  points;  forces  which  would  produce  that  specified  motion 
of  the  center  of  gravity  of  the  substructure  under  the  presence  of  friction 
and  gravity.  This  procedure,  although  a  rough  approximation  leads  to  a 
relatively  fast  computer  model. 

B.1.2  Prescribed  Motor-Rotor  Vibration 

The  motor-rotor  motion  can  be  easily  determined  experimentally  from  en¬ 
coder  data,  and  this  motion,  including  vibration,  may  be  used  as  input  to 
the  mathematical  model.  We  drive  the  mathematical  model  using  this  pre¬ 
scribed  motor-rotor  vibration  while  ignoring  the  forcing  function  exerted 
by  the  amplifier-motor  combination.  The  procedure  developed  for  this  pur¬ 
pose  had  to  be  restricted  to  the  available  data,  that  is,  to  the  use  of  modal 
parameters  only.  Two  suitable  techniques  for  this  analysis  are  described  in 
what  follows. 

Frequency-Domain  Technique 

There  is  a  very  powerful  technique  for  this  application  which  works  in  the 
frequency  domain  through  the  use  of  Fourier  transforms,  unfortunately  it 
is  only  valid  for  time- invariant  systems.  This  can  be  briefly  described  as 
follows:  Consider  a  flexible  system  as  shown  in  Figure  B.l  where  a  force 
fp(t)  is  applied  at  the  point  P  producing  a  vibration  xp(t).  Suppose  we 
know  x p(t)  and  the  transfer  function 
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Flexible  system 


Figure  B.l:  Flexible  system 


(fl.51) 


which  may  be  synthesized  from  the  modal  parameters  as  follows: 

n  I x [i)\2 

(w,) 

Then,  by  taking  the  Fourier  transform  of  xp(t)  to  get  Xp(uj)  we  can  calculate 
Fp(oj),  and  after  taking  the  inverse  Fourier  transform  we  can  get  fp[t).  With 
fp(t)  known,  we  can  then  integrate  the  equations  of  motion 


W  +  [2fi.w.]{p}  +  [«2]{p}  =  M*{/} 


{B.  52) 


to  get  the  vibration  at  any  point  of  the  structure  by  means  of  {xq}  = 

Another  procedure  which  may  be  faster  to  apply  consists  of  the  follow¬ 
ing.  Assume  that  we  also  know  Hpq(w)  as  indicated  below,  and  we  wish 
to  calculate  xq[t). 


HrQ{u)  --  E  — ; — VrV- - 

.  -u>~  +-  W,  h 


(B- 5.1) 
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Then 

=  TM  <B'54) 

Solving  for  Fu( cj)  in  equation  B.50  and  B.54  we  can  then  equate  both 
expressions  to  get: 

=  rfi^MXrl'u)  (B-55) 

Then  we  calculate  iy(t)  from  equation  B.55  by  inverse  transforming  Xq(u) 
,  all  without  explicitly  calculating  the  force 

One  source  of  error  in  this  process  may  come  from  the  use  of  the  FFT 
which  assumes  that  the  function  xp(t)  is  periodic,  but  in  this  case  of  robot 
motions  there  is  a  start  point.  This  start  condition  is  normally  taken  into 
account  by  extending  the  time  history  back  from  time  zero,  that  is: 

0  for  t  <  0 

x p(t)  for  t  >  0 

and  giving  enough  span  to  get  good  approximation. 

Even  though  this  technique  was  not  applied  to  the  study  of  the  robot 
vibrations,  it  could  be  used  to  get  approximate  results  if  we  considered 
average  values  for  the  transfer  functions  involved. 

Time-Domain  technique 

A  time-domain  technique  which  can  be  of  more  general  application  is  the 
following: 

Consider  the  same  system  of  Figure  B.l  where  we  ultimately  want  to 
determine  the  vibration  x(t)  at  any  point  by  knowing  xp(t)  but  not  fp[t). 
The  system  can  be  described  by  the  truncated  system  of  uncoupled  equa¬ 
tions  B.52.  Since  there  is  only  one  external  force  fp(t)  acting  on  the  system, 
we  can  express  the  modal  force  as 

-  {«}'{//•}  (0.57) 


(£.56) 
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where  {a}  is  formed  by  the  modal  matrix  evaluated  at  point  P  in  the 
direction  of  the  force. 

In  addition  to  the  n  equations  of  B.52,  we  have  another  condition  to  be 
satisfied: 

{ir}  =  [<£p]{p}  =  {a}*{p}  (B.58) 

So,  we  have  n  -f  1  equations  and  n  -f-  1  unknowns,  those  are  {p}  and  //>. 

Assuming  that  a,  0  for  all  i  we  can  eliminate  from  equation  B.52  fP 
by  combining  the  n  equations  to  get  n  —  I  equations  as  follows: 

•  multiply  1st  equation  by  ±  +  ^joqp!  +  ^-wjpj  =  fp- 

•  multiply  i  +  1th  equation  by  : 

Z~;P'~+  ‘  +  J^-wf+iPi+l  =  fp- 


Subtract  to  get  the  ith  new  equation  without  the  term  in  fP.  Then  we 
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get  n  -  I  equations  for  the  n  variables  p, 


P 2  (  + 


±  0 
a  i 


al  °2  a3  U4 


0  0 

at 


(B.  59) 


0 

«2 


0  0  0  0  . 


Now  we  can  apply  equation  B.58  to  add  another  equation  (or  row)  in 
such  a  way  that  the  mass  matrix  remains  non-singular,  that  is,  by  differ¬ 
entiating  equation  B.58  twice  with  respect  to  time: 


{x>}  =  {4>p}{p}  -  {a}'{p} 


(fl.60) 


so,  the  nth  equation  of  B.59  after  the  addition  would  contain  {a}  in  the  mass 
matrix  and  the  corresponding  forcing  function  would  be  {£/>}.  Therefore, 
starting  with  a  coupled  system  of  equations  given  by  equation  B.52  and 
equation  B.58,  vve  end  up  with  a  coupled  system  of  equations  which  is 
driven  by  the  prescribed  motion  ip{t),  and  which  can  be  integrated  directly 
to  determine  {p}  and  ultimately  {x}. 
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Substructure  A  Substructure  B 

Figure  B.2:  Two  substructures  A,B 

One  important  observation  regarding  the  application  of  this  method  is 
that  the  differentiation  of  xp  with  respect  to  time  assumes  that  <f>l}  —  0. 
This  is  strictly  correct  for  a  time- invariant  system,  but  only  approximately 
valid  for  a  slowly-varying  system.  For  the  general  case  we  would  have  to 
include  terms  in  fa,  and  4>,j  in  the  equations  of  motion. 
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APPLICATION  TO  A  SIMPLE  CASE 

In  order  to  evaluate  these  methods,  we  consider  a  simple  case  which  can 
illustrate  with  detail  what  we  have  applied  to  the  study  of  the  cartesian 
robot.  To  make  it  more  similar  to  the  robot  case,  we  include  a  connection 
of  two  substructures. 

The  problem  is  defined  as  follows.  Consider  the  two  substructures,  A 
and  B,  as  shown  in  Figure  B.2.  Given  ii (t)  of  the  assembled  system,  find 
12(f)  of  the  same  assembled  system  for  two  different  cases: 
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Impulse  response. 


Step  response. 


Synthesis  of  Modal  Data  for  Assembled  System 
Substructure  A  has  the  following  modal  parameters: 


0  0 


-w-  v; 


vim  vim  t  = 


’/2m  V2m 


(B.  61) 


.  Substructure  B  has 


wi=^.w  =  -L.  </»}=« 

m  y/m 

The  uncoupled  equations  before  assembly  are  given  by 


(6.62) 


{Pa}  +  1"2a]{Pa}  =  MTVa}  =  ^ 

V  V2”» 

{Pn}  +  [w|]{pfl}  =  [0b]{/b}  =  {' 


The  compatibility  condition  requires  that 


(6.63) 


{x2}  =  {x3},  or{<t>Aj\{pA}  =  \4>d\{Pb} 


(5.64) 


Choosing  Pb  as  the  generalized  coordinate  to  be  eliminated,  we  get 


{pb}  =  [4>d\-1[M{pa}  =  [  X  ~±}{Pa} 


(5.65) 


Then,  the  transformation  matrix  T  as  defined  by  formula  2.7  becomes 


1  ,  for  the  case 


(5.66) 
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The  assembled  system  is  obtained  by 

m  =  mrm,  [*]  =  [rnw!]|ri,  =  mTw{/} 

.  Substituting  the  previously  obtained  values,  we  get: 


H  l  J  l  *  J  L  -¥  +  ¥  J 

.  This  assembled  system  has  the  eigenvalues 


2  _  l,3kA+kD  +  /0k\  -  2kAkD  +  k^ 

wt.2  =  7  - - -  V - —2 - 

4  m  _  V  m* 


(B.  67) 


(B.  68) 


(B.  69) 


and  the  eigenvectors 


4>  11  <^12 
<f>U  fcl 


(B.  70) 


This  can  be  verified  to  be  exactly  correct  for  the  resulting  system  shown 
in  Figure  B.3. 


Analysis  by  Frequency-Domain  Technique 

In  order  to  get  the  response  at  x2  given  the  response  at  xt,  we  can  apply 
the  frequency-domain  technique  described  above.  First  we  decouple  the 
system  of  equations  given  by  B.68  to  get 


u/f  0 

0  ui2 


{4>n 


(012  +  022)  7^; 


.  The  transfer  function  at  point  x\  is 

LI  t .  .%  _  ^11 


#11  M  = 


*ji  ,  012 

2  2  2  2 
U —  UT  w 


(B.  71) 


{B.  72) 


So,  by  applying  equation  B.72  we  can  obtain  Fi{“)  and  from  there 
Integrating  equations  B.68  we  can  determine  x i(t)  as  shown  below,  or  we 
can  use  Hl2  in  combination  with  Hu  in  formula  3.5*  *o  get  X2(w)  directly, 
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Figure  B.3:  Assembled  A-B 
Analysis  by  Time-Domain  Technique 
The  prescribed  vibration  Xi  (t)  is  related  to  the  variables  q  by 

9i 


xi  =  [<t>m  =  { 7^ } 


<72 


(B.  73) 


.  First  we  eliminate  /j  from  equation  B.68  by  subtracting  the  first  row 
from  the  2nd  to  get 


.  Differentiating  equation  B.73  twice  with  respect  to  time,  and  adding  that 
equation  to  B.74  we  get 
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These  equations  B.75  can  be  integrated  directly  to  get  and  q2(t) 
to  then  get 


Xi(t)  =  {02I  {9}  =  <^21<71  +  ^2272  (#76) 


An  alternative  way  to  arrive  at  the  differential  equation  driven  by  the 
prescribed  motion  ii  consists  of  eliminating  one  of  the  q*  ,  say  q2  from 
equation  B.73,  and  substitute  in  equation  B.75  to  get  a  single  equation 


9i  + 


fe a  + 

2m 


9i 


■s/2  m 

4m 


(2^  +  kD)xi 


(B.  77) 


Results 


Two  kinds  of  inputs  or  prescribed  motions  at  xx  can  be  employed  now.  The 
impulse  response  is  given  by 

x-i (t)  =  —  sin  (w2t)  4-  —  sin  (u>jt)  (B. 78) 

U/2  Wj 


and  the  step  response  by 

*,(«)  =  ~  cos  (wi<))  +  (1  -  cos  [u3t))  (B.79) 


The  corresponding  responses  at  z2  as  given  by  the  first  method  are 
shown  in  Figure  B.4  and  Figure  B.5,  where  the  calculated  response  is  the 
top  plot  and  the  expected  response  x2(t)  is  shown  for  comparison  at  the 
bottom.  Both  results,  the  calculated  and  the  expected,  are  very  similar. 


Appendix  C 


PRELIMINARY  STUDY  OF 


VIBRATIONS  OF 


A  GEOMETRICALLY 


NONLINEAR  SYSTEM 


C.l  Preliminary  Vibration  Analysis 


Before  we  started  doing  the  analysis  of  the  cartesian  robot,  we  were  involved 


in  the  study  of  the  vibration  characteristics  of  a  four-bar  linkage  with  elastic 


input  and  output  shafts  which  presented  some  common  characteristics  with 
the  cartesian  robot,  and  from  whose  analysis  we  could  get  insights  into  the 
problem  of  position-dependent  systems.  The  experience  obtained  in  the 
preliminary  study  facilitated  the  development  of  a  procedure  to  analyze 
the  robot  vibrations,  and  that  is  why  we  dedicate  this  Appendix  to  its 


presentation. 


The  system  consists  of  a  crank-rocker  mechanism  with  flexible  input 
and  output  shafts  (see  Figure  C.l).  The  input  shaft  transmits  power  from 
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Figure  C.l:  Continuous  parameter  model  of  the  system 


an  ideal  motor,  represented  by  its  rotor  inertia  f(),  to  the  crank.  The  input 
shaft  stiffness  is  normally  high  as  is  the  first  natural  torsional  frequency 
of  the  shaft  considered  in  isolation.  Also  the  shaft  inertia  is  usually  quite 
small  as  compared  to  that  of  the  rotor.  Therefore,  the  shaft  may  be  modeled 
as  a  linear  torsional  spring  and  viscous  damper  with  spring  and  damping 
coefficients  K i  and  C j. 


For  this  study  the  crank  and  connecting  rod  are  assumed  to  be  short 
and  their  natural  frequencies  in  bending,  considered  as  isolated  beams  are 
assumed  high  when  compared  with  the  length  and  bending  natural  fre¬ 
quency  of  the  rocker.  Therefore  the  input  link  is  considered  to  be  a  rigid 
link  of  mass  mi  and  inertia  U  and  the  coupler  link  is  modeled  as  a  link  of 
mass  m3  inertia  />w  and  axial  stifTncss  K>.  The  rocker  is  a  long  uniform 
member;  it  has  mass  m3,  and  elasticity  in  bending  only.  The  output  shaft 
is  rigidly  attached  to  the  rocker,  and  is  perpendicular  to  the  rocker’s  plane 


of  motion.  It  is  a  uniform  circular  shaft  of  length  />,,  diameter  </„,  polar 
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moment  of  inertia  I*  density  p,  ,and  shear  modulus  G,.  At  the  end  of  the 
shaft  there  is  a  system  load  represented  as  an  inertia  /4. 

Before  proceeding  to  derive  the  equations,  we  should  point  out  the  sim¬ 
ilarities  and  differences  with  the  robot  problem: 

•  For  a  given  configuration  of  these  systems,  the  modal  characteristics 
can  be  calculated  by  one  of  several  methods,  and  these  modal  param¬ 
eters  may  be  different  from  those  corresponding  to  another  configura¬ 
tion,  that  is,  by  changing  relative  positions  the  boundary  conditions 
of  some  elements  may  change,  or  the  relative  inertias  and  stiffnesses 
may  vary.  This  is  true  for  both  systems,  and  as  we  will  see  later,  the 
method  to  obtain  the  modal  parameters  has  to  be  chosen  according 
to  the  system  complexity,  and  the  more  complex  the  system,  the  sim¬ 
pler  the  method  ought  to  be  in  order  to  be  able  to  solve  the  resulting 
differential  equations. 

•  The  four-bar  linkage  p  oblem  consists  of  finding  steady-state  solutions 
and  the  cyclic  variation  of  the  system  coefficients  is  fast  as  compared 
to  the  vibration  which  takes  place  superposed  on  the  rigid  body  mo¬ 
tion.  On  the  other  hand,  the  cartesian  robot  p-oblem  concerns  finding 
transient  vibrations  which  occur  during  motion  of  the  carriages;  tiffs 
system  can  be  modeled  as  a  slowly  varying  one,  that  is,  the  system 
coefficients  vary  slowly  as  compared  to  the  vibrations.  In  both  cases, 
the  solution  involves  integration  of  a  system  of  differential  equations 
with  variable  coefficients. 
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using  Finite  Element  methods  to  study  an  clastic  linkage.  In  their  analysis 
they  considered  effects  of  input  speed  fluctuations.  In  1973, Imam,  Sandor 
and  Kramer  [42]  applied  quasi-static  structural  techniques  to  this  prob¬ 
lem;  they  included  in  their  analysis  the  rate  of  change  of  eigenvalues  and 
eigenvectors  to  reduce  the  computer  time.  In  1973,  Sadler  and  Sandor  [68] 
analyzed  a  linkage  with  rigid  crank  and  elastic  coupler  links  using  Euler- 
Bernoulli  theory  for  beams;  to  solve  the  equations  they  used  the  difference 
approximation  and  Taylor  expansions.  The  same  authors  in  1974  [69]  ana¬ 
lyzed  a  crank-rocker  mechanism  with  rotational  inertia  in  the  output.  They 
modeled  the  crank  link  as  a  cantilever  beam  and  the  coupler  and  rocker 
links  as  simply  supported  beams. Sutherland  [74]  ,  in  1976  assumed  sinu¬ 
soidal  mode  shapes  for  the  elastic  links  in  order  to  model  their  behavior; 
he  applied  both  analytical  and  numerical  methods  to  solve  the  equations. 
For  all  of  these  analyses,  the  input  link  is  assumed  to  be  driven  directly  by 
the  motor;  for  many  cases,  input  link  angular  velocity  is  considered  con¬ 
stant  and  there  are  no  loads  assumed  to  be  acting  on  the  system  except 
the  inertia  loads  of  the  links.  In  fact  however,  most  linkages  in  use  are 
driven  through  input  shafts  which  are  not  rigid  and  motions  of  interest 
are  often  those  of  inertias  being  driven  by  shafts  connected  to  the  output 
or  rocker  link.  Examples  are  found  in  industrial  sewing  machines,  paper 
making  machines,  packaging  machines,  and  others.  Often  the  frequencies 
of  the  first  torsional  resonances  of  the  input  and  output  shafts  are  near 
the  bending  frequencies  of  the  links.  As  a  result,  the  resonances  of  the 
system  are  coupled  and  cannot  be  evaluated  correctly  unless  the  character¬ 
istics  of  the  input  and  output  shafts  are  taken  into  consideration.  In  1978, 
Sanders  and  Tesar  [70]  performed  an  analytical  and  experimental  study  of 
linkages  with  transverse  coupler  link  vibrations  which  are  uncoupled  with 
the  vibrations  of  the  rest  of  the  system.  They  recommend  relatively  robust 
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mechanisms  for  high  speed  linkages.  However,  robust  mechanisms  carry 
weight  penalties  which  are  unacceptable  in  many  applications.  As  demand 
for  faster  systems  is  increasing  a^d  because  vibration  is  the  phenomenon 
which  most  often  limits  the  speed  at  which  a  high-speed  mechanism  can 
operate,  it  is  important  to  develop  tools  for  predicting  frequency  response 
for  mechanisms  consisting  of  flexible  linkages  and  elastic  input  and  output 
shafts.  To  date  only  a  few  authors  have  included  in  their  models  the  effects 
of  flexibility  in  the  system  input  and  output  shafts  or  the  effects  of  inertial 
loads  on  the  ends  of  these  shafts.  In  1967,  Capellen  [13]  considered  input 
and  output  shafts  but  did  not  account  for  any  elasticity  in  the  linkage  it¬ 
self.  In  1977,  Kohli,  Hunter  and  Sandor  [50]  included  the  elastic  effects  of 
supports  and  input  and  output  shafts  on  the  vibration  of  an  elastic  linkage; 
they  applied  fourier  series  representations  to  model  the  deflections  of  the 
links.  In  this  paper  we  consider  the  case  in  which  a  four-bar  linkage  with  an 
elastic  rocker  or  output  link  is  driven  by  a  motor  through  a  flexible  input 
shaft  and  drives,  through  connection  to  the  rocker  link,  a  flexible  output 
shaft  which  in  turn  drives  an  inertial  load. (Figure  C.l). 

Starting  with  a  continuous  parameter  model  of  the  system,  the  behavior 
of  the  rocker-beam  is  analyzed,  and  from  these  results  a  lumped  parame¬ 
ter  model  is  constructed.  Then  the  equations  of  motion  are  linearized  to 
get  a  system  of  differential  equations  with  periodic  coefficients.  Finally  a 
dimensional  analysis  leads  to  a  procedure  for  design  of  such  linkages  whose 
resonances  do  not  match  frequencies  of  system  energy  input. 
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C.3  Description  of  the  Continuous  Parame¬ 
ter  Model 

Figure  C.l  shows  a  crank-rocker  mechanism  with  flexible  input  and  out¬ 
put  shafts.  Two  discrete  and  two  continuous  generalized  coordinates  are 
required  to  describe  this  system.  They  are  the  following: 

•  #o  ,  the  angular  position  of  the  motor  rotor 

•  di  ,  the  angular  position  of  the  input  link 

•  u(y,t)  ,  the  displacement  from  static  equilibrium  of  all  points  on  the 
rocker 

•  </>(x,  t )  ,  the  torsional  displacement  from  static  equilibrium  of  all 
poi.  ts  on  the  output  shaft. 

We  shall  derive  the  equations  of  motion  of  this  continuous  system  for  dis¬ 
crete  configurations;  that  is,  for  small  motions  about  a  given  position  of 
the  crank;  using  the  energy  Method  [20]. 

C.3.1  Kinetic  co-energies 

The  system  elements  have  the  following  kinetic  co-energies: 

•  Output  shaft:  77  =  \  /*>  p,I,.{ft)2dx 
.  Inertia  /<  :  7?  = 

•  Rocker:  =  \  ft'  p3A3{^)2dy 

•  Crank:  T4‘  =  i/,0’ 

•  Motor  inertia:  7V  =  '  Inff2 
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•  Coupler:  T0*  =  ^At)*,  where 

A  =  h,vi\  +  mi(L\  +  ^x2  +  L,Liii  cos  (9,  -  <?2))  where  t2  and  x'j  (used 
later)  are  the  angular  velocity  ratios  as  defined  by  Paul  [60]. 

•  _  <h  _  L\  <in  (0i  -  *1 ) 

2  0\  ~  Li  ““  (Oj  0 .,) 
i,  =  ji  -  Li  -in  (0j  0i) 

3  0,  L4  «m  (0j  -  83) 

•  Total  kinetic  energy:  T'  =  T,  -f  T2  +  ...  +  T8* 

C.3.2  Potential  Energies 

The  system  elements  have  the  following  potential  energies: 

•  Output  shaft:  V,  =  ±  tf3  GJp.{%)2dx 
.  Rocker:  V2  =  i  E3I33($)2dy 

•  Input  shaft:  V3  =  \K i(0t  —  90 )J 

•  Coupler  axial  spring:  VK  =  iKi{N,L\9,  -  jV2uj,)2  ,  where 

N\  -  sin  (9 1  —  02)  and  Nj  =  sin  (9j  -  9V)  are  the  factors  that  project 
the  displacements  at  the  ends  of  the  coupler  in  the  direction  of  the 
coupler,  and 

uL  =  u{L,  t). 

•  Total  potential  energy  :  V  =  V\  +  V2-\-VZ  +  V\ 

C.3.3  Generalized  Forces 

Variation  of  virtual  work  is  6W  =  To69n  —  0,9,69,  —  Cj(^)ro^0' 

Then  Z0n  =  *£=  To,  Z6,  =  -0,9,,  Z+,  =  -Ca(&),=0 
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Using  Hamilton’s  principle  (20j  we  obtain: 

VI  =  f\6L  +  £)  Z,6Sj)dtt  L=T'  -V 

Jtl  y  1 

Substitution  of  above  expressions  for  T  and  V  into  the  expression  for  the 
Variational  indicator  and  then  integration  by  parts  both  timewise  and 
spacewise  produces  the  equations  of  motion  and  boundary  conditions  at 
the  vanishing  of  the  Variational  indicator  for  arbitrary  variations  of  the 
generalized  coordinates.  These  are  as  follows: 

P.%£  +  G,%$=0in0<x<L. 

PzA3%$  +  E3I 330  =  OinO  <  y  <  L3 
I*^$  +  G,IP'  jg  =  0  at  x  —  L„ 

GJP. f*a=0  ~  C2%x=0  +  E3/33(0)tf= o  =  Oat  *  =  0,y  =  0 
0  =0afy  =  L3 

(/i  +  A)9x  +  C\Q\  -f-  K\{9i  —  9q)  +  K2NiLi(NiLi9i  —  N2ul)  =  0, 
at 

/o0o  ■+■  Kx{9q  —  0i )  =  Oaf  0o 

E3I33^s  +  K2N2(NiLx9i  —  iV3«t)  =  0  aty  =  L3 

For  this  derivation  the  equation  of  motion  for  0i  has  been  linearized 
by  considering  small  motions  about  a  given  configuration.  To  solve  the 
eigenvalue  problem,  we  put  temporarily  Cx  =  C2  =  0,  To  =  0  and  try 
solutions  of  the  form: 

rp(x,  t )  =  an(i)  sin  (w„t  +  <f> ) 
u(y,t)  =  6n(y)sin  (wnt  +  </») 

0i  (f)  =  0i  sin  ( unt  +  <t>) 

0O (t)  =  0o  sin  (w„t  +  4>) 

The  substitution  of  these  solutions  into  the  above  equations  gives: 


p,ui^aH(x)  -h  C7,-— ^  =  0, znO  <  x  <  L, 


(C.80) 
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-  ^3i43w;6n(x)  +  £3/33 — =  in®  <  y  <  L3  (C.81) 

-uJl{rl+A)e1  +  Kl{dl-0t))+K2N^L2l9l-K2NlN2Llbn{L)  =Q,atdl  {C. 82) 
—  la^n^o  +  Kii^o  —  0])  —  0,  at  0o  (C.83) 


—  Louj^ffu  +  Ki(&o  —  $i)  —  0,  at  0q 

Gslp.  ^  -  hu\an  =  0 ,atx  =  L, 

GJP.  ^  +  Ei  1 33  ~-^V  -  =  0,  at  x  =  0,y  =  0 

dif>4y)  n  ,  r 

— dyT~  =  0  ,aty  =  Lz 


(C.84) 

(C.85) 

(C.86) 


-  £3/33^  +  K2Nl bn(y)  -  K2N{N2lA  =0,  at  y  =  Li  (C. 87) 

Also  from  geometry:  6„(0)  =  0,  and  an(0)  =  (^)y=o 
From  (1)  we  get: 

a„(x)  =  Cy  sm  —=  +  C2  cos  —= 


From  (2)  we  get: 

bn(y)  =  C3  sin  0y  +  Ct  cos  0y  +  C5  sinh  0y  +  C6  cosh  /3y 

where  0  = 

After  some  manipulations  in  order  to  eliminate  the  constants  C\  through 
Co,  0\  and  6a  we  can  get  the  transcendental  equation: 


where 


Zj  —  Zj 


^(2  sin  (ILi  +  2sinh/?i.1) 


(C.88) 


^(cot  -  cothfiLi)  + 


/^WW«P(  *  ) 

w  \  t  f*t _ \  <■'  *  Pt  | 

C.I„  y/c\i  fi.  sin  (-=^4-)  v  /<w„  cos  (  -^nXx_  | J 

T  V  «  •  '  P*  \  *■»  •  '  /*• 


7^7 ~  ~  A,«n)  +  ^ v(cot^L3  -cothjgLa) 
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with 

~Ki  +  | -uHl,  +  A)  +  Kl  + 

K2NlN2Ll 

From  equation  C.88  we  can  obtain  an  infinite  set  of  eigenvalues  which  con¬ 
sists  of  a  subset  reflecting  rocker  bending,  a  subset  reflecting  shaft  torsional 
vibration  and  a  subset  reflecting  lumped  parameter  vibration  modes.  The 
behavior  of  the  rocker  is  particularly  important  because  one  of  its  eigenval¬ 
ues  may  be  at  or  near  the  system  energy  input  frequency  for  some  system 
configurations  and  the  magnitudes  of  its  eigenvalues  depend  on  all  the  pa¬ 
rameters  of  the  system.  For  example,  if  the  stiffness  of  the  input  shaft  is 
large  and  /0  (motor  inertia)  is  large,  the  rocker  tends  to  behave  as  a  beam 
whose  upper  end  is  pinned,  whereas  if  the  input  shaft  stiffness  is  small, the 
rocker  tends  to  behave  as  a  free-end  beam.  Additionally,  if  both  the  stiff¬ 
ness  of  the  output  shaft  and  the  output  inertia  I4  are  large,  then  near  the 
fixed  bearing  the  rocker  tends  to  behave  as  a  clampcd*end  beam  while  if 
this  stiffness  is  small, it  behaves  as  a  pinned-end  beam.  To  illustrate  this 
behavior  we  define  a  parameter  a  as  follows: 

a  /  £1/33 

^1, bending  y  P2AjLj 

where  a  depends  on  the  boundary  conditions.  Values  of  a  for  typical  bound¬ 
ary  conditions  are  as  follows  [29]: 

•  hinged-clamped  a  =  3.91 

•  hinged-hinged  a  =  ir 

•  cantilever  o  =  1.87 

•  free-hinged  a  =  0. 

After  solving  the  eigenvalue  problem  for  several  values  of  K 1  and  K,  for 


TOM'. 


fixed  we  obtain  the  behavior  of  a  vs  K\  for  the  two  values  of  K„  (sec 
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Figure  C.2:  Behavior  of  a  vs.  Ky  for  various  values  of  K, 

Figure  C.2).  Note  that  in  the  case  where  both  input  and  output  shafts  are 
soft,  a  for  the  rocker  takes  a  value  (aero)  appropriate  for  a  beam  hinged  or 
pinned  at  its  base  and  free  at  the  coupler  end.  When  both  shafts  are  stiff, 
the  value  of  a  is  that  of  a  beam  clamped  at  the  base  and  hinged  at  the 
other  end.  For  a  soft  input  and  stiff  output  shaft,  the  value  of  a  is  that  of 
a  cantilever  ,  while  for  a  stiff  input  and  a  soft  output  shaft  a  has  the  value 
fitting  a  hinged-hinged  beam. 

C.4  Description  of  Simplified  Models 

For  most  actual  systems,  the  motor  inertia  is  very  high  compared  to  the 
inertias  of  each  link  of  the  mechanism  and  the  input  shaft  is  short  and 
therefore  very  stiff.  Existence  of  these  conditions  implies  that  the  rocker 
will  behave  near  the  rocker-coupler  joint  as  a  pinned  beam.  Based  on  this 
implication,  a  bending  deformation  pattern  for  the  rocker  can  be  assumed 
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Figure  C.3:  Lumped  parameter  model  of  the  system 

and  a  much  simpler  system  model,  described  by  a  set  of  ordinary  differential 
equations,  can  then  be  developed.  Validity  of  this  assumption  ,  for  a  specific 
system  can  be  checked  by  comparing  results  of  this  simplified  analysis  to 
those  obtained  from  the  analysis  of  the  more  precise  continuous  model. 
From  the  simple  model,  a  finite  number  of  eigenvalues  and  mode  shapes 
will  be  obtained.For  most  problems,  only  a  finite  range  of  eigenvalues  is 
of  interest  and  so  the  loss  of  higher  eigenvalues  is  not  a  serious  limitation, 
and  the  simplified  system  equations  are  much  easier  to  solve  than  are  those 
for  the  continuous  model.  For  the  case  of  a  large  motor  inertia  and  a  stiff 
input  shaft,  the  vibration  induced  deflection  pattern  of  the  rocker  link  can 
be  assumed  to  be  sinusoidal. 

u(y ,0  =  q(t)  sin  — 

For  this  case,  a  nondimensionnl  generalized  coordinate  z  =  q/Lz  is  chosen. 
The  output  shaft  is  modeled  as  a  massless  spring  K„.  Figure  C.3  shows 
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this  simplified  model.The  Lagrangian  for  this  system  is  as  follows: 

L  =  \9\\h  +  I +  rn3{L\  +  ^ cos  (0j  —  02))]  + 

^L)9q  +  ihQ  4  +  (C- 89) 

-\Kl{9l  -  0O)2  -  ^(9,  -  03  -  nzy  -  'i^z* 
where  it z,  the  slope  of  the  rocker  beam  near  the  fixed  bearing  relative 
to  its  position  at  static  equilibrium,  is  considered  approximately  equal  to 
the  angle  made  by  a  tangent  to  the  beam  at  the  fixed  bearing  with  respect 
to  the  position  of  the  beam  in  static  equilibrium.  From  the  Lagrangian 
we  can  derive  equations  of  motion  which  are  nonlinear  ordinary  differential 
equations.  Note  that  the  term  in  m3  is  the  kinetic  energy  of  the  beam  and 
is  obtained  by 


,  where 


KE=\p3Aij\‘ldy 


v  =  93y  -+  zL3  sin 


and  the  term  in  z  is  the  potential  energy  of  the  beam  and  is  obtained  by 

To  obtain  a  more  precise  but  still  a  simple  set  of  system  equations,  we 
can,  instead  of  taking  z.L3sin(^)  as  the  first  natural  mode  of  the  beam, 
take  the  actual  mode  shape  obtained  from  the  continuous  parameter  model 
discussed  above,  then 

bi(y,t)  =  *£3(^3  sin  0y  +  C4  cos  0y  +  C5  sinh  0y  +  C6cosh/ty] 
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where  C3,C4,C5  and  Ce  are  determined  for  a  particular  case  from  the  con¬ 
tinuous  model.  The  kinetic  and  potential  energies  then  become: 


APPENDIX  C.  PRELIMINARY  STUDY  OF  VIBRATIONS 


210 


IOOOO 


_I000 

N 

z 


0  100  200  300  400 

8 j  (degrees) 

Figure  C.4:  Variation  of  three  natural  frequencies  with  crank  position  for 
quasi-static  case 

where  f\,  f 2,  f 3  are  constants  derived  for  the  particular  case.  When  these 
energies  are  incorporated  into  the  Lagrangian  (10),  we  obtain  equations  of 
motion,  this  time  by  use  of  Lagrange’s  equations,  which  more  precisely 
describe  the  bending  motion  of  the  link,  (see  equation(ll)  which  for  ui  =  0 
gives  the  quasi-stat<c  case.)  For  a  given  linkage  configuration  we  linearize 
the  equations  of  motion  and  since  the  coefficients  are  constant  we  can  form 
and  solve  the  eigenvalue  problem.  When  this  solution  is  obtained  for  various 
configurations  we  can  determine  the  variation  of  the  system  eigenvalues  in 
one  cycle  of  the  crank  as  a  function  of  crank  angle.  Figure  C.4  shows 
how  the  eigenvalues  change  for  discrete  crank  positions.  Shown  are  results 
for  the  continuous  model.  Results  obtained  from  the  lumped  mass  models 
are  very  similar.  To  obtain  values  for  these  eigenvalues,  we  have  used  the 
system  parameters  calculated  from  drawings  of  a  linkage  which  is  part  of 
an  industrial  sewing  machine  that  has  presented  its  manufacturer  with  a 
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serious  vibration  problem  during  high  speed  operation. 

This  system  exhibited  a  strong  vibration  at  400  Hz  with  the  crank  speed 
at  100  Hz,  illustrating  that  even  for  a  small  ratio  of  crank  length  to  ground 
link  length,  0.13  in  this  case,  the  geometric  nonlinearity  brought  about  an 
important  parametric  excitation.  Values  of  the  chosen  system  parameters 
are  shown  in  table  C.l. 

The  lumped  parameter  system  has  four  generalized  coordinates  and  has 
therefore  four  eigenvalues,  one  of  which  is  zero.  Note  that  for  the  frequency 
range  of  interest (0-1000  Hz)  the  eigenvalues  are  nearly  constant  around  the 
cycle  and  this  allows  us  to  consider  /i,/2t/3  to  be  constants. 


C.5  Comparison  of  the  Continuous  and  Lumped 
Mass  Models 

In  order  to  illustrate  the  comparison  of  the  eigenvalues  obtained  from  the 
lumped  parameter  models  with  the  ones  obtained  from  the  continuous  pa¬ 
rameter  model  which  are  known  to  be  more  precise,  we  have  solved  each 
eigenvalue  problem  for  various  system  parameters  with  the  crank  position 
fixed  at  90  degrees  .  These  results  are  shown  in  figure  C.5  and  Figure  C.6. 
Differences  in  the  first  eigenvalues  are  seen  to  be  small  for  a  wide  range  of 
input  shaft  stiffnesses  for  two  choices  of  output  shaft  stiffnesses. Maximum 
difference  is  5  %  of  the  peak  value. 


C.6  Linearized  System  Vibration  for  Steady 
Motor  Rotation 


In  order  to  linearize  the  equations  of  motion  we  assume  that  the  motor 
rotates  at  constant  speed  and  that  a  small  amplitude  vibration  can  be 
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Li  —  .02  rn 

m,  =  4.0834125  -  2  Kg 

Lj  =  .035 m 

m2  =  2.G9775E  -  2  Kg 

Lj  =  .150m 

m3  =  1.7010525  -  2  Kg 

G  =  .155m 

/0  =  2.82528 E  -  1  Kg  -  m2 

In  =  9.037 E  -  12m4 

h  =  5.1208225  -  6Kg  -  m2 

E3  =  2.06UlEUN/m2 

I2  =  2.74G825  -  6 Kg  -  m2 

Ki  =  5258  N-m/nid 

I3  =  1  2753£  -  4 Kg  -  m2 

K,  =  202  N-m/rad 

U  =  15G25  -  3 Kg  -  m2 

Table  C.l:  Data  of  a  Particular  Mechanism 
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-  continuous  model 

- lumped  model,  exoct 

mode  shape 

- lumped  model,  sinusoidol 
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Log  K1/K3 

Figure  C.5:  Comparison  of  behavior  of  first  natural  frequency  in  bending 
obtained  from  the  continuous  and  the  lumped  models.  Case  of  jjsj  =0.1 
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Figure  C.6:  Comparison  of  behavior  of  first  natural  frequency  in  bending 
obtained  from  the  continuous  and  the  lumped  models.  Case  of  =  10. 

superimposed  on  the  rigid  body  motion.  Then  we  can  obtain  a  system  of 
linear  differential  equations  with  periodic  coefficients.  To  do  this  we  define 
a  new  generalized  coordinate  V’i  which  will  replace  0$  and  0t  ,thus  reducing 
the  number  of  degrees  of  freedom  to  three,  as  follows: 

i/>i  =  0i  -  0o.  0i  =  +  wt 

where  w  is  the  angular  velocity  of  the  motor  and  t  is  the  time.  To  first 


order  approximation 


03  =  03  +  tsV*! 


where  03  is  the  rocker  position  for  rigid  body  motion  and  0j  is  the  corrected 


value.  Also 


01  =  V>i  +  W, 

0i  =  V»i, 

03  =  +  ij'fii 
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The  equations  of  motion  obtained  from  this  system  can  be  linearized  as 

follows: 

t/> i  =  6rpi  ( already  small ) 
z  —  Sz  ( already  small) 

#4  =  ^3  +  SO4 

These  equations  then  are  : 

[  A  0  1  (  6^  ) 


^m3L§*j  0  firn3L]  j  [  Iz  j 

[j4*u»  •+■  Ci  —  Cjtj  — Cjij  TCjij 

— Cjtj  Cj  -TCj 

re,*,  —tc3  t2c3  +  c3 

Ki  +  ffjij  ~K3i3  TK3i3 

—  Kji  3  Ki  -TKt 

TK2i3  ~TK3  T2K2  +  f3£g* 

=-£<jJ2  -  C2tjw 

—  I+K2ui2  +  Cjtju 
z^1m3LlK':iu/2  —  Cjijw 


^4  [  + 


(C.90) 


where 


•  A  =  Ji  4-  /jtf 4-  m2[Lj  +  J^2ll  +  L\L3i3  cos  -  02)] 

•  T  =  a(C3  +  Cj),  obtained  from  mode  shape(continuous  model) 

•  K's  = 

J  W  (8 

These  equations  (11)  can  be  integrated  numerically  to  get  the  steady  state 
response  and  determine  the  amplitudes  of  vibration  and  the  frequency  con¬ 
tent. 

Because  the  process  of  numerical  integration  can  be  expensive  in  terms 
of  computer  time,  it  is  helpful  to  perform  a  dimensional  analysis  before 
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integrating.  Then  each  numerical  solution  will  apply  to  a  family  of  mecha¬ 
nisms.  Define  the  nondimensional  parameters: 


Kz  =  *£*.  A  = 

0*  =  Z^K.u  '  Di  = 


and  the  following  parameters  with  dimensions  of  frequency: 


^4  =  \fj*<  ^5  = 


=  /-£», 

V  mjii 


n5  = 


v 

l-fc  +  imtLl 

Hin  =  .  /  *2 I 


_ 


Define  also  a  dimensionless  time  ?  =  fi4t  Then, 


=  04(5^1, 

The  equations  of  motion  (11)  become  after  some  manipulations: 


0  /i  J  (  Sz  J 
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Figure  C.7:  Frequency  response  of  two  members  of  a  family  of  mechanisms. 
The  original  data  corresponds  to  ordinate  2 

•  A  =  (B;)’ +*?(£)’  +  (£)’  +  - «.)  +  't 

•  T  =  a(C'3  +  C5),  obtained  from  mode  shape(continuous  model) 

•  Ki  = 

From  these  equations  (12)  we  can  observe  clearly  the  consequences  of  dy¬ 
namic  similarity  [64].  If  for  example  the  system  has  a  small  value  for  the 
damping  ratio  as  most  mechanisms  do,  then  changing  all  the  stiffnesses 
proportionally,  or  all  the  inertias  proportionally  will  not  change  the  dy¬ 
namic  response  expressed  in  nondimensional  variables.  Therefore,  all  the 
systems  that  have  the  same  ratio  °f  -7^,  belong  to  a  fam¬ 

ily  whose  dynamic  response  is  unique.  By  translating  the  results  from  the 
nondimensional  space  to  a  dimensional  space,  we  can  produce  the  following 
graph. (See  figure  C.7). 
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This  figure  shows  the  frequency  response  for  two  members  of  the  family. 
Each  data  point  represents  an  angular  displacement  of  the  inertial  mass  on 
the  output  shaft  as  determined  from  a  numerical  integration  with  respect 
to  its  expected  position  for  rigid  body  motion  during  operation  at  the  given 
motor  angular  velocity.  The  angular  displacement  is  an  RMS  displacement 
measured  at  25C  points  during  six  cycles  of  the  input  crank  after  the  system 
had  reached  equilibrium.  For  the  two  members  of  the  family  shown,  all 
system  stiffnesses  differ  by  a  factor  of  2;  damping  ratios  and  inertias  for  both 
are  the  same.  From  the  figure  we  see  that  if  amplitudes  are  plotted  vs  w2  , 
points  of  constant  response  amplitude  for  the  two  family  members  occur  at 
frequencies  which  lie  on  a  straight  line  emanating  from  the  origin.  This  is  as 
expected  on  the  basis  of  the  system  equations  (12)  and  of  dynamic  similarity 
[64].  After  the  frequency  response  for  one  member  of  the  family  is  obtained, 
these  results  can  be  extended  to  any  other  member  simply  by  scaling  the 
frequency  axis  appropriately.  Having  performed  this  analysis  for  a  family 
from  which  a  designer  expects  to  pick  a  member,  and  having  determined 
from  design  considerations  the  frequencies  (driving  frequency  for  example) 
at  which  energy  will  be  introduced  into  the  system,  the  designer  can  now 
pick  a  member  of  the  family  whose  frequency  response  at  the  known  input 
frequencies  is  low. 

C.7  Summary 

Analysis  of  a  four-bar  linkage  system  with  flexible  input  and  output  shafts 
has  shown  that  for  typical  system  parameters,  the  flexibility  in  the  driv¬ 
ing  and  driven  shafts  have  a  significant  influence  on  the  system  response. 
Quasi-static  response  has  been  reported  for  a  continuous  parameter  system 
model,  and  this  response  has  been  compared  to  that  obtained  for  much 
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simpler  lumped  parameter  system  models.  For  wide  ranges  of  system  pa¬ 
rameters,  the  lumped  system  responses  are  similar  to  those  obtained  from 
the  more  precise  continuous  system  model.  Values  for  first  and  second 
system  natural  frequencies  are  shown  to  vary  only  slightly  with  changes  in 
system  geometry.  Two  sets  of  nondimensionalized  lumped  parameter  model 
system  equations,  one  assuming  sinusoidal  mode  shape  for  the  rocker  link 
and  one  using  for  rocker  link  mode  shapes  the  shapes  determined  from 
the  quasi-static  analysis  of  the  continuous  model,  have  been  integrated  nu¬ 
merically  to  establish  dynamic  system  response.  Resulting  plots  of  RMS 
displacement  of  the  output  shaft  about  its  calculated  rigid  body  motion  po¬ 
sition  vs.  frequency  of  the  input  shaft  rotation  can  be  examined,  and  from 
these  results,  and  on  the  basis  of  dynamic  similarity,  design  parameters  for 
the  system  can  be  chosen  so  as  to  minimize  RMS  response  at  frequencies 
to  which  the  system  is  likely  to  be  subjected. 


